📄 vp_filter.c
字号:
/* vp_filter.c
*
*-------------------------------------------------------------------------------
*
* I N T E L P R O P R I E T A R Y
*
* COPYRIGHT (c) 2002 BY INTEL CORPORATION. ALL RIGHTS
* RESERVED. NO PART OF THIS PROGRAM OR PUBLICATION MAY
* BE REPRODUCED, TRANSMITTED, TRANSCRIBED, STORED IN A
* RETRIEVAL SYSTEM, OR TRANSLATED INTO ANY LANGUAGE OR COMPUTER
* LANGUAGE IN ANY FORM OR BY ANY MEANS, ELECTRONIC, MECHANICAL,
* MAGNETIC, OPTICAL, CHEMICAL, MANUAL, OR OTHERWISE, WITHOUT
* THE PRIOR WRITTEN PERMISSION OF :
*
* INTEL CORPORATION
*
* 2200 MISSION COLLEGE BLVD
*
* SANTA CLARA, CALIFORNIA 95052-8119
*
*-------------------------------------------------------------------------------
*
*
* system: IXDP2400
* subsystem: DIAG
* author: chinmay, NOVEMBER, 2002
*
*
* ------------------------------------------------------------------------------
*/
typedef unsigned long ulong;
typedef unsigned short ushort;
#include "common.h"
#include "memory.h"
#include "msf_common.h"
#include "diagstruct.h"
#include "led.h"
#include "uc_load.h"
#include "pci_diag.h"
#include "pci.h"
#include "hal_ixdp2400.h"
#include "memory.h"
#include "syslog.h"
#include "uart.h"
#include "msf_init.h"
#include "diag_utils.h"
#include "error_code.h"
#include "error_map.h"
#include "reg_api.h"
#include "register_map.h"
#include "diag.h"
#include "dp_proto.h"
#include "mac_util.h"
#include "mac_init.h"
#define VLAN_PKTFILCTRL 0x8
#define PAUSE_PKTFILCTRL 0x0
#define HI_MUL_ADDR 0xA1B0C0D0
#define LO_MUL_ADDR 0xE0F0
#define MPHY 1
#define VLAN_CHECK 0x8100
#define PAUSE_CHECK 0x8100
short VCount[4],PCount[4];
extern const int pl_sys_loopback_eg_rx[];
extern const int pl_sys_loopback_eg_tx[];
extern const int pl_sys_loopback_in_rx[];
extern const int pl_sys_loopback_in_tx[];
extern UINT32 Sz_pl_sys_loopback_eg_rx;
extern UINT32 Sz_pl_sys_loopback_eg_tx;
extern UINT32 Sz_pl_sys_loopback_in_rx;
extern UINT32 Sz_pl_sys_loopback_in_tx;
extern UINT32 vlan64_0[];
extern UINT32 pause64_0[];
extern UINT32 data96_0[];
extern UINT32 data96_1[];
extern UINT32 data96_2[];
extern UINT32 data96_3[];
extern UINT32 data138_0[];
extern UINT32 data138_1[];
extern UINT32 data138_2[];
extern UINT32 data138_3[];
extern pci_device slave_dev_info; // for slave npu info.
extern UINT32 PKT_96_SZ,PKT_64_SZ,PKT_138_SZ;
extern UINT32 PKT_SEQ_SZ,ALL_PORT_PKT_SEQ_SZ;
extern UINT32 *pl_sys_lb_data96_0;
extern UINT32 *pl_sys_lb_data64_0;
extern UINT32 *pl_sys_lb_data138_0;
extern UINT32 *pl_sys_lb_data96_1;
extern UINT32 *pl_sys_lb_data64_1;
extern UINT32 *pl_sys_lb_data138_1;
extern UINT32 *pl_sys_lb_data96_2;
extern UINT32 *pl_sys_lb_data64_2;
extern UINT32 *pl_sys_lb_data138_2;
extern UINT32 *pl_sys_lb_data96_3;
extern UINT32 *pl_sys_lb_data64_3;
extern UINT32 *pl_sys_lb_data138_3;
extern UINT32 tx_data_pl[];
extern UINT32 tx_data_pl_0[];
extern UINT32 tx_data_pl_1[];
extern UINT32 tx_data_pl_2[];
extern UINT32 tx_data_pl_3[];
extern UINT32 rxport[4];
#define VLAN_PKTS 3 /* expected unicast packets, per port */
#define PAUSE_PKTS 3 /* expected broadcast packets, per port */
#define EXP_DROPPED_PKTS 3 /* expected dropped packets, per port */
#define VLAN_FILTER_FAILED 0xBAD4
#define PAUSE_FILTER_FAILED 0xBAD5
/** globals **/
extern UINT32 total_args,loop,ports,speed;
extern char channel,test_opt;
extern UINT8 test_param;
extern UINT32 validate_params(void);
extern UINT32 init_mac_dev(UINT32);
extern UINT32 assign_pkt_pointers(UINT32 ports, UINT32 *pktptr, UINT32 cflag, UINT32 *pnum);
/* local functions */
void get_packets_for_vpse_filter_test(void);
short verify_vpse_filter(UINT32 cflag);
void get_vpse_error(UINT32 pkt_size, UINT32 exp_pkt_sz, UINT32 *mailbox_value);
// ******************************************************************************
// Function: void vlan_pause_filter_test(void)
//
// This function is called by the Test Manager when the user invokes the
// point Lone VLAN/PAUSE frame filtering test.
// ******************************************************************************
UINT32 vlan_pause_filter_test(void)
{
UINT32 ctr, flag, slave_mailbox0_addr, pkt_size, status, tx_count=0, rx_count=0;
UINT32 scratch_ring_tx_count, scratch_ring_rx;
UINT32 dcache_status, forever = 0, combination, port_num, rx_port_num;
UINT32 loop_count=0;
UINT32 *pl_sys_lb_data=0;
UINT32 scratch_read_value=0, dram_addr, orig_data_size=0;
volatile int mailbox_value, temp;
register PDiagCommon acL = (PDiagCommon) ACADDRESS;
UINT32 pass_port[4],rxflag[4];
UINT32 expected_num_pkts = 0,iteration = 0, port_ctr=0, pnum=0, *pktptr=0;
UINT32 exp_pkt_sz = 0,cflag = 0;
/***************************************************************************
** The rxport is to be indexed by the txport and the value is the corresponding rxport.
** Tx port Rxport
** 0 1
** 1 0
** 2 3
** 3 2
*********************************************************************************/
UINT32 rxport[4] = {1, 0, 3, 2};
UINT32 bad_pkt_size = 0;
UINT32 test_passed=0,counter=0;
channel = 'f';
total_args = acL->argc;
test_opt = acL->argv[2][0];
test_param = acL->argv[3][0];
channel = acL->argv[4][0];
speed = acL->decArg[5];
ports = acL->decArg[6];
loop = acL->decArg[7];
if (validate_params() == INVALID_PARAMETERS)
{
eprintf("Invalid parameters. \n");
return INVALID_PARAMETERS;
}
if (channel == 'c')
{
cflag = 1;
}
if (total_args <= 7)
{
loop = 1;
}
if (loop == 0)
{
forever = 1;
}
else
{
forever = 0;
}
/* initialize port array to 0 */
for (ctr = 0;ctr<4;ctr++)
{
pass_port[ctr] = 0;
rxflag[ctr] = ERROR;
/* initialize counts to 0 */
VCount[ctr]=0;
PCount[ctr]=0;
}
/* get the packet data used specifically for the test */
get_packets_for_vpse_filter_test();
iteration = assign_pkt_pointers(ports, pktptr, cflag, &pnum);
switch(ports)
{
case 0: pktptr = tx_data_pl_0;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
break;
case 1: pktptr = tx_data_pl_1;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
break;
case 2: pktptr = tx_data_pl_2;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
break;
case 3: pktptr = tx_data_pl_3;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
break;
case 4: pktptr = tx_data_pl;
pnum = ALL_PORT_PKT_SEQ_SZ/(4*4);
if (cflag)
iteration = 2;
else
iteration = 4;
break;
}
scratch_ring_rx = SCR_RING_INSTR_ADDR + (5 << 2);
scratch_ring_tx_count = SCR_RING_INSTR_ADDR + (4 << 2);
if(acL->HostType == MASTER) // if master NPU
{
flag = OK;
Msf_OutOfReset();
status = Msf_PLL();
if (status == ERROR)
{
return ABORT;
}
eprintf("Initialising media card. Please wait...\n");
status = init_mac_dev(0);
if (status != DONE)
{
eprintf("Aborting Test\n");
return ABORT;
}
clear_stat_regs();
spConfig();
#if 0
/* clear drop pkt counters */
reg_read(0x5A2);
reg_read(0x5A3);
reg_read(0x5A4);
reg_read(0x5A5);
#endif
switch(test_param)
{
case 'l':
reg_write((RXFIFO_DROP_ENABLE),0xF);
for(port_ctr=0; port_ctr<NUM_PORTS;port_ctr++)
{
/*filter vlan packets */
reg_write((PKT_FILTER_CTL+(port_ctr*PORTSZ)),VLAN_PKTFILCTRL);
}
break;
case 'p':
/* bad packets to be dropped */
reg_write((RXFIFO_DROP_ENABLE),0xF);
for(port_ctr=0; port_ctr<NUM_PORTS;port_ctr++)
{
/* filter pause packets */
reg_write((PKT_FILTER_CTL+(port_ctr*PORTSZ)),PAUSE_PKTFILCTRL);
}
case '2': /* This case handles the RMON Pause/Vlan stat reg test */
case '3':
/* bad packets to be dropped */
reg_write((RXFIFO_DROP_ENABLE),0xF);
for(port_ctr=0; port_ctr<NUM_PORTS;port_ctr++)
{
/* filter pause packets */
reg_write((PKT_FILTER_CTL+(port_ctr*PORTSZ)),PAUSE_PKTFILCTRL);
}
break;
default :
eprintf("Invalid parameters. \n");
return INVALID_PARAMETERS;
}
spRestore();
eprintf("Media card initialisation completed.\n");
dcache_status = get_CP15() & DCACHE_BIT;
if(dcache_status != 0) // if dcache ON
{
dcache_off();
}
*(PCI_ADDR_EXT_REG) = (slave_dev_info.base_address[CSR_BAR] & 0xE0000000) >> 16;
slave_mailbox0_addr = slave_dev_info.base_map[CSR_BAR] + PCI_CSR_BASE_FRM_PCI + MAILBOX_0_OFF;
PUT32(slave_mailbox0_addr, 0);
#ifdef __ARMEB__
PUT32((slave_dev_info.base_map[CSR_BAR] + PCI_CSR_BASE_FRM_PCI + MAILBOX_3_OFF), SWAP32(1));
#else
PUT32((slave_dev_info.base_map[CSR_BAR] + PCI_CSR_BASE_FRM_PCI + MAILBOX_3_OFF), 1);
#endif
PUT32((SCRATCHPAD_BASE + SCRATCH_MSG_BASE), DRAM_BASE_SRC);
// Write packet data to DRAM for microcode to use
for (ctr = 0; ctr < PKT_96_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_96_0 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data96_0[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_64_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_64_0 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data64_0[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_138_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_138_0 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data138_0[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_96_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_96_1 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data96_1[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_64_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_64_1 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data64_1[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_138_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_138_1 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data138_1[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_96_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_96_2 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data96_2[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_64_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_64_2 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data64_2[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_138_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_138_2 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data138_2[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_96_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_96_3 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data96_3[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_64_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_64_3 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data64_3[(ctr / 4)]);
}
for (ctr = 0; ctr < PKT_138_SZ; ctr+=4)
{
PUT32((DRAM_BASE_SRC + ((RING_DATA_138_3 >> 8) & (MASK_16BIT << 8)) + ctr), pl_sys_lb_data138_3[(ctr / 4)]);
}
PUT32((PCI_LOCAL_CSR_BASE + MAILBOX_0_OFF), 0);
// Invoke the slave's PCI doorbell
Set_Pci_Doorbell(PTLONE_SYS_LPBK, (slave_dev_info.base_map[CSR_BAR] + PCI_CSR_BASE_FRM_PCI + XSCALE_DOORBELL_OFF));
ctr = 0;
// Wait for a signal that slave NPU has completed loading of ucode and init
do
{
if (ctr == 1500) // After 10 seconds
{
eprintf("\nTimed out...Slave NPU was not able to load microcode and init.\n");
mailbox_value = INIT_ERROR;
flag = ERROR;
break;
}
temp = GET32(slave_mailbox0_addr);
hal_delay_us(10000);
ctr++;
}
while (temp == 0);
if (flag == OK) // If slave completed microcode loading successfully
{
// Load Master's NPU with ucode and init
DownLoadUcode(PL_SYS_LOOPBACK_EG_TX_ME, Sz_pl_sys_loopback_eg_tx, (UINT32 *)pl_sys_loopback_eg_tx);
DownLoadUcode(PL_SYS_LOOPBACK_EG_RX_ME, Sz_pl_sys_loopback_eg_rx, (UINT32 *)pl_sys_loopback_eg_rx);
hal_delay_us(1000000);
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -