/*
PCI device probe & initialization function
*/
static int DEVINIT rt_pci_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id)
{
void *pAd = NULL, *handle;
struct net_device *net_dev;
const char *print_name;
unsigned long csr_addr;
int rv = 0;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
unsigned long OpMode;
DBGPRINT(RT_DEBUG_TRACE, ("===> %s()\n", __FUNCTION__));
/*PCIDevInit============================================== */
/* wake up and enable device */
if ((rv = pci_enable_device(pdev))!= 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("Enable PCI device failed, errno=%d!\n", rv));
return rv;
}
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)
print_name = pci_name(pdev);
#else
print_name = pdev->slot_name;
#endif /* LINUX_VERSION_CODE */
if ((rv = pci_request_regions(pdev, print_name)) != 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("Request PCI resource failed, errno=%d!\n", rv));
goto err_out;
}
/* map physical address to virtual address for accessing register */
csr_addr = (unsigned long) ioremap(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
if (!csr_addr)
{
DBGPRINT(RT_DEBUG_ERROR, ("ioremap failed for device %s, region 0x%lX @ 0x%lX\n",
print_name, (ULONG)pci_resource_len(pdev, 0), (ULONG)pci_resource_start(pdev, 0)));
goto err_out_free_res;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("%s: at 0x%lx, VA 0x%lx, IRQ %d. \n", print_name,
(ULONG)pci_resource_start(pdev, 0), (ULONG)csr_addr, pdev->irq));
}
/* Set DMA master */
pci_set_master(pdev);
/* Allocate RTMP_ADAPTER adapter structure */
os_alloc_mem(NULL, (UCHAR **)&handle, sizeof(struct os_cookie));
if (handle == NULL)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s(): Allocate memory for os handle failed!\n", __FUNCTION__));
goto err_out_iounmap;
}
memset(handle, 0, sizeof(struct os_cookie));
((POS_COOKIE)handle)->pci_dev = pdev;
#ifdef OS_ABL_FUNC_SUPPORT
{
RTMP_PCI_CONFIG PciConfig;
PciConfig.ConfigVendorID = PCI_VENDOR_ID;
/* get DRIVER operations */
RTMP_DRV_OPS_FUNCTION(pRtmpDrvOps, NULL, &PciConfig, NULL);
}
#endif /* OS_ABL_FUNC_SUPPORT */
rv = RTMPAllocAdapterBlock(handle, &pAd); /* we may need the pdev for allocate structure of "RTMP_ADAPTER" */
if (rv != NDIS_STATUS_SUCCESS)
goto err_out_iounmap;
#ifdef MULTI_INF_SUPPORT
if (pAdGlobalList[0] == NULL)
pAdGlobalList[0] = pAd;
else if (pAdGlobalList[1] == NULL)
pAdGlobalList[1] = pAd;
else
DBGPRINT(RT_DEBUG_ERROR, ("%s(): pAdGlobalList assign Error !\n", __FUNCTION__));
#endif /* MULTI_INF_SUPPORT */
RTMP_DRIVER_PCI_CSR_SET(pAd, csr_addr);
RTMP_DRIVER_PCIE_INIT(pAd, pdev);
/*NetDevInit============================================== */
net_dev = RtmpPhyNetDevInit(pAd, &netDevHook);
if (net_dev == NULL)
goto err_out_free_radev;
/* Here are the net_device structure with pci-bus specific parameters. */
net_dev->irq = pdev->irq; /* Interrupt IRQ number */
net_dev->base_addr = csr_addr; /* Save CSR virtual address and irq to device structure */
pci_set_drvdata(pdev, net_dev); /* Set driver data */
/*All done, it's time to register the net device to linux kernel. */
/* Register this device */
#ifdef RT_CFG80211_SUPPORT
{
/* pAd->pCfgDev = &(pdev->dev); */
/* pAd->CFG80211_Register = CFG80211_Register; */
/* RTMP_DRIVER_CFG80211_INIT(pAd, pdev); */
/*
In 2.6.32, cfg80211 register must be before register_netdevice();
We can not put the register in rt28xx_open();
Or you will suffer NULL pointer in list_add of
cfg80211_netdev_notifier_call().
*/
CFG80211_Register(pAd, &(pdev->dev), net_dev);
}
#endif /* RT_CFG80211_SUPPORT */
RTMP_DRIVER_OP_MODE_GET(pAd, &OpMode);
rv = RtmpOSNetDevAttach(OpMode, net_dev, &netDevHook);
if (rv)
goto err_out_free_netdev;
#ifdef PRE_ASSIGN_MAC_ADDR
{
UCHAR mac_addr[MAC_ADDR_LEN];
RTMP_DRIVER_MAC_ADDR_GET(pAd, &mac_addr[0]);
DBGPRINT(RT_DEBUG_TRACE, ("@%s MAC address: %02x:%02x:%02x:%02x:%02x:%02x\n",
__FUNCTION__, mac_addr[0], mac_addr[1],
mac_addr[2], mac_addr[3],
mac_addr[4], mac_addr[5]));
/* Set up the Mac address */
RtmpOSNetDevAddrSet(OpMode, net_dev, &mac_addr[0], NULL);
}
#endif /* PRE_ASSIGN_MAC_ADDR */
DBGPRINT(RT_DEBUG_TRACE, ("<=== %s()\n", __FUNCTION__));
return 0; /* probe ok */
/* --------------------------- ERROR HANDLE --------------------------- */
err_out_free_netdev:
RtmpOSNetDevFree(net_dev);
err_out_free_radev:
/* free RTMP_ADAPTER strcuture and os_cookie*/
RTMPFreeAdapter(pAd);
err_out_iounmap:
iounmap((void *)(csr_addr));
release_mem_region(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
err_out_free_res:
pci_release_regions(pdev);
err_out:
pci_disable_device(pdev);
DBGPRINT(RT_DEBUG_ERROR, ("<=== %s() failed with rv = %d!\n",
__FUNCTION__, rv));
return -ENODEV; /* probe fail */
}
static INT __devinit rt2860_probe(
IN struct pci_dev *pci_dev,
IN const struct pci_device_id *pci_id)
{
VOID *pAd = NULL;
struct net_device *net_dev;
PVOID handle;
PSTRING print_name;
ULONG csr_addr;
INT rv = 0;
RTMP_OS_NETDEV_OP_HOOK netDevHook;
ULONG OpMode;
DBGPRINT(RT_DEBUG_TRACE, ("===> rt2860_probe\n"));
/*PCIDevInit============================================== */
/* wake up and enable device */
if ((rv = pci_enable_device(pci_dev))!= 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("Enable PCI device failed, errno=%d!\n", rv));
return rv;
}
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,5,0)
print_name = pci_name(pci_dev);
#else
print_name = pci_dev->slot_name;
#endif /* LINUX_VERSION_CODE */
if ((rv = pci_request_regions(pci_dev, print_name)) != 0)
{
DBGPRINT(RT_DEBUG_ERROR, ("Request PCI resource failed, errno=%d!\n", rv));
goto err_out;
}
/* map physical address to virtual address for accessing register */
csr_addr = (unsigned long) ioremap(pci_resource_start(pci_dev, 0), pci_resource_len(pci_dev, 0));
if (!csr_addr)
{
DBGPRINT(RT_DEBUG_ERROR, ("ioremap failed for device %s, region 0x%lX @ 0x%lX\n",
print_name, (ULONG)pci_resource_len(pci_dev, 0), (ULONG)pci_resource_start(pci_dev, 0)));
goto err_out_free_res;
}
else
{
DBGPRINT(RT_DEBUG_TRACE, ("%s: at 0x%lx, VA 0x%lx, IRQ %d. \n", print_name,
(ULONG)pci_resource_start(pci_dev, 0), (ULONG)csr_addr, pci_dev->irq));
}
/* Set DMA master */
pci_set_master(pci_dev);
/*RtmpDevInit============================================== */
/* Allocate RTMP_ADAPTER adapter structure */
/* handle = kmalloc(sizeof(struct os_cookie), GFP_KERNEL); */
os_alloc_mem(NULL, (UCHAR **)&handle, sizeof(struct os_cookie));
if (handle == NULL)
{
DBGPRINT(RT_DEBUG_ERROR, ("%s(): Allocate memory for os handle failed!\n", __FUNCTION__));
goto err_out_iounmap;
}
memset(handle, 0, sizeof(struct os_cookie));
((POS_COOKIE)handle)->pci_dev = pci_dev;
#ifdef OS_ABL_FUNC_SUPPORT
{
RTMP_PCI_CONFIG PciConfig;
PciConfig.ConfigVendorID = PCI_VENDOR_ID;
/* get DRIVER operations */
RTMP_DRV_OPS_FUNCTION(pRtmpDrvOps, NULL, &PciConfig, NULL);
}
#endif /* OS_ABL_FUNC_SUPPORT */
rv = RTMPAllocAdapterBlock(handle, &pAd); /* we may need the pci_dev for allocate structure of "RTMP_ADAPTER" */
if (rv != NDIS_STATUS_SUCCESS)
goto err_out_iounmap;
/* Here are the RTMP_ADAPTER structure with pci-bus specific parameters. */
/* pAd->CSRBaseAddress = (PUCHAR)csr_addr; */
RTMP_DRIVER_PCI_CSR_SET(pAd, csr_addr);
/* RTMPInitPCIeDevice(pci_dev, pAd); */
RTMP_DRIVER_PCIE_INIT(pAd, pci_dev);
/*NetDevInit============================================== */
net_dev = RtmpPhyNetDevInit(pAd, &netDevHook);
if (net_dev == NULL)
goto err_out_free_radev;
/* Here are the net_device structure with pci-bus specific parameters. */
net_dev->irq = pci_dev->irq; /* Interrupt IRQ number */
net_dev->base_addr = csr_addr; /* Save CSR virtual address and irq to device structure */
pci_set_drvdata(pci_dev, net_dev); /* Set driver data */
#ifdef NATIVE_WPA_SUPPLICANT_SUPPORT
/* for supporting Network Manager */
/* Set the sysfs physical device reference for the network logical device
* if set prior to registration will cause a symlink during initialization.
*/
#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0))
SET_NETDEV_DEV(net_dev, &(pci_dev->dev));
#endif
#endif /* NATIVE_WPA_SUPPLICANT_SUPPORT */
/*All done, it's time to register the net device to linux kernel. */
/* Register this device */
#ifdef RT_CFG80211_SUPPORT
{
/* pAd->pCfgDev = &(pci_dev->dev); */
/* pAd->CFG80211_Register = CFG80211_Register; */
/* RTMP_DRIVER_CFG80211_INIT(pAd, pci_dev); */
/*
In 2.6.32, cfg80211 register must be before register_netdevice();
We can not put the register in rt28xx_open();
Or you will suffer NULL pointer in list_add of
cfg80211_netdev_notifier_call().
*/
CFG80211_Register(pAd, &(pci_dev->dev), net_dev);
}
#endif /* RT_CFG80211_SUPPORT */
RTMP_DRIVER_OP_MODE_GET(pAd, &OpMode);
rv = RtmpOSNetDevAttach(OpMode, net_dev, &netDevHook);
if (rv)
goto err_out_free_netdev;
#ifdef CONFIG_STA_SUPPORT
/* pAd->StaCfg.OriDevType = net_dev->type; */
RTMP_DRIVER_STA_DEV_TYPE_SET(pAd, net_dev->type);
#endif /* CONFIG_STA_SUPPORT */
/*#ifdef KTHREAD_SUPPORT */
#ifdef PRE_ASSIGN_MAC_ADDR
UCHAR PermanentAddress[MAC_ADDR_LEN];
RTMP_DRIVER_MAC_ADDR_GET(pAd, &PermanentAddress[0]);
DBGPRINT(RT_DEBUG_TRACE, ("@%s MAC address: %02x:%02x:%02x:%02x:%02x:%02x\n", __FUNCTION__, PermanentAddress[0], PermanentAddress[1],PermanentAddress[2],PermanentAddress[3],PermanentAddress[4],PermanentAddress[5]));
/* Set up the Mac address */
RtmpOSNetDevAddrSet(OpMode, net_dev, &PermanentAddress[0], NULL);
#endif /* PRE_ASSIGN_MAC_ADDR */
DBGPRINT(RT_DEBUG_TRACE, ("<=== rt2860_probe\n"));
return 0; /* probe ok */
/* --------------------------- ERROR HANDLE --------------------------- */
err_out_free_netdev:
RtmpOSNetDevFree(net_dev);
err_out_free_radev:
/* free RTMP_ADAPTER strcuture and os_cookie*/
RTMPFreeAdapter(pAd);
err_out_iounmap:
iounmap((void *)(csr_addr));
release_mem_region(pci_resource_start(pci_dev, 0), pci_resource_len(pci_dev, 0));
err_out_free_res:
pci_release_regions(pci_dev);
err_out:
pci_disable_device(pci_dev);
DBGPRINT(RT_DEBUG_ERROR, ("<=== rt2860_probe failed with rv = %d!\n", rv));
return -ENODEV; /* probe fail */
}