pfe_ctrl/pfe_mod.c

#include <linux/dma-mapping.h>
#include "pfe_mod.h"
#include "version.h"

struct pfe *pfe;

#if defined(CONFIG_UNIT_TEST)
extern void pfe_unit_test(struct pfe *pfe);
#if defined(UNIT_TEST_HIF)
void hif_unit_test(struct pfe *pfe);
#endif
#endif

/**
 * pfe_probe - 
 *
 *
 */
int pfe_probe(struct pfe *pfe)
{
	int rc;

	printk(KERN_INFO "%s\n", __func__);

	printk(KERN_INFO "PFE Driver version:\n%s\nbuilt with pfe sources version: %s\n", PFE_CTRL_VERSION, PFE_VERSION); 

	if (DDR_MAX_SIZE > pfe->ddr_size) {
		printk(KERN_ERR "%s: required DDR memory (%x) above platform ddr memory (%x)\n", __func__, DDR_MAX_SIZE, pfe->ddr_size);
		rc = -ENOMEM;
		goto err_hw;
	}

	if (((int) (pfe->ddr_phys_baseaddr + BMU2_DDR_BASEADDR) & (8*SZ_1M - 1)) != 0) {
			printk(KERN_ERR "%s: BMU2 base address (0x%x) must be aligned on 8MB boundary\n", __func__, (int) pfe->ddr_phys_baseaddr + BMU2_DDR_BASEADDR);
			rc = -ENOMEM;
			goto err_hw;
	}


	printk(KERN_INFO "cbus_baseaddr: %lx, ddr_baseaddr: %lx, ddr_phys_baseaddr: %lx, ddr_size: %x\n",
			(unsigned long)pfe->cbus_baseaddr, (unsigned long)pfe->ddr_baseaddr,
			pfe->ddr_phys_baseaddr, pfe->ddr_size);

	pfe_lib_init(pfe->cbus_baseaddr, pfe->ddr_baseaddr, pfe->ddr_phys_baseaddr, pfe->ddr_size);

	rc = pfe_hw_init(pfe);
	if (rc < 0)
		goto err_hw;

	rc = pfe_hif_lib_init(pfe);
	if (rc < 0)
		goto err_hif_lib;

	rc = pfe_hif_init(pfe);
	if (rc < 0)
		goto err_hif;

	rc = pfe_firmware_init(pfe);
	if (rc < 0)
		goto err_firmware;

	rc = pfe_ctrl_init(pfe);
	if (rc < 0)
		goto err_ctrl;

	rc = pfe_eth_init(pfe);
	if (rc < 0)
		goto err_eth;

	rc = pfe_vwd_init(pfe);
	if (rc < 0)
		goto err_vwd;

	rc = pfe_pcap_init(pfe);
	if (rc < 0)
		goto err_pcap;

	rc = pfe_perfmon_init(pfe);
	if(rc < 0)
		goto err_perfmon;

	rc = pfe_sysfs_init(pfe);
	if(rc < 0)
		goto err_sysfs;

	rc = pfe_diags_init(pfe);
	if(rc < 0)
		goto err_diags;

#if defined(CONFIG_COMCERTO_MSP)
	rc = pfe_msp_sync_init(pfe);
	if(rc < 0)
		goto err_msp;
#endif

#if defined(CONFIG_UNIT_TEST)
	pfe_unit_test(pfe);
#endif

	return 0;

#if defined(CONFIG_COMCERTO_MSP)
err_msp:
	pfe_diags_exit(pfe);
#endif

err_diags:
	pfe_sysfs_exit(pfe);

err_sysfs:
	pfe_perfmon_exit(pfe);

err_perfmon:
	pfe_pcap_exit(pfe);

err_pcap:
	pfe_vwd_exit(pfe);

err_vwd:
	pfe_eth_exit(pfe);

err_eth:
	pfe_ctrl_exit(pfe);

err_ctrl:
	pfe_firmware_exit(pfe);

err_firmware:
	pfe_hif_exit(pfe);

err_hif:
	pfe_hif_lib_exit(pfe);

err_hif_lib:
	pfe_hw_exit(pfe);

err_hw:
	return rc;
}


/**
 * pfe_remove - 
 *
 *
 */
int pfe_remove(struct pfe *pfe)
{
	printk(KERN_INFO "%s\n", __func__);

#if defined(CONFIG_COMCERTO_MSP)
	pfe_msp_sync_exit(pfe);
#endif
	pfe_diags_exit(pfe);

	pfe_sysfs_exit(pfe);

	pfe_perfmon_exit(pfe);

	pfe_pcap_exit(pfe);

	pfe_vwd_exit(pfe);

	pfe_eth_exit(pfe);

	pfe_ctrl_exit(pfe);

	pfe_firmware_exit(pfe);

	pfe_hif_exit(pfe);

	pfe_hif_lib_exit(pfe);

	pfe_hw_exit(pfe);

	return 0;
}