📄 power_diag.c
字号:
/* power_diag.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 UNI_PKTFILCTRL 0x1
#define MUL_PKTFILCTRL 0x2
#define BRD_PKTFILCTRL 0x4
#define HI_MUL_ADDR 0xA1B0C0D0
#define LO_MUL_ADDR 0xE0F0
#define MPHY 1
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 const int mphy_loopback_eg_rx[];
extern const int mphy_loopback_eg_tx[];
extern const int mphy_loopback_in_rx[];
extern const int mphy_loopback_in_tx[];
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 Sz_mphy_loopback_eg_rx;
extern UINT32 Sz_mphy_loopback_eg_tx;
extern UINT32 Sz_mphy_loopback_in_rx;
extern UINT32 Sz_mphy_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 *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[];
#define UC_PKTS 3 /* expected unicast packets, per port */
#define MC_PKTS 3 /* expected multicast packets, per port */
#define BC_PKTS 3 /* expected broadcast packets, per port */
#define EXP_DROPPED_PKTS 3 /* expected dropped packets, per port */
extern UINT32 data64_0[];
extern UINT32 data64_1[];
extern UINT32 data64_2[];
extern UINT32 data64_3[];
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[];
/** 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 void Set_Pci_Doorbell(int bit_num, int db_intr_addr);
extern UINT32 assign_pkt_pointers(UINT32 ports, UINT32 *pktptr, UINT32 cflag, UINT32 *pnum);
/** local functions **/
// ******************************************************************************
// Function: void powerDown_test(void)
//
// This function is called by the Test Manager when the user invokes the
// point Lone SPI-3 diagnostics test.
// ******************************************************************************
UINT32 powerDown_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=0, 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;
int rxerr=0;
//UINT32 fail_port=0xFF;
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 counter=0, exp_port_num=0, act_port_num=0;
channel = 'f';
ports=0;
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;
eprintf("PowerDown Test is not supported in Copper mode\n");
return ABORT;
}
if (total_args <= 7)
{
loop = 1;
}
if (loop == 0)
{
forever = 1;
}
else
{
forever = 0;
}
if (ports !=4)
{
eprintf("Power Down test is not valid for a single port.\n");
eprintf("Please provide '4' as the port number for all ports.\n");
return ABORT;
}
/* initialize port array to 0 */
for (ctr = 0;ctr<4;ctr++)
{
pass_port[ctr] = 0;
rxflag[ctr] = ERROR;
}
/* get the packet data used specifically for the test */
get_packets_for_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;
exp_port_num = ports;
break;
case 1: pktptr = tx_data_pl_1;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
exp_port_num = ports;
break;
case 2: pktptr = tx_data_pl_2;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
exp_port_num = ports;
break;
case 3: pktptr = tx_data_pl_3;
pnum = PKT_SEQ_SZ/4;
iteration = 1;
exp_port_num = ports;
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();
//eprintf("Test param = %c\n",test_param);
spConfig();
/* configure MPHY 1x32 operation */
config_mphy();
switch(test_param)
{
case 'r':
eprintf("Testing Rx Power down...\n");
reg_write((RXFIFO_DROP_ENABLE),0xF);
reg_write((PORT_ENABLE),0x0);
if (ports == 4) /* power down all ports */
//reg_write(SERDES_TX_RX_POW_DOWN,0xF);
reg_write(SERDES_TX_RX_POW_DOWN,0x3C0F);
else
reg_write(SERDES_TX_RX_POW_DOWN,(1<<ports));
reg_write(SERDES_CLKMODE_REG,0x0);
reg_write(SERDES_CLKMODE_REG,0xf);
reg_write(0x505,0xf);
reg_write(0x505,0x0);
reg_write((PORT_ENABLE),0xF);
break;
case 't':
eprintf("Testing Tx Power down...\n");
reg_write((RXFIFO_DROP_ENABLE),0xF);
reg_write((PORT_ENABLE),0x0);
if (ports == 4) /* power down all ports */
reg_write(SERDES_TX_RX_POW_DOWN,0x3C00);
else
reg_write(SERDES_TX_RX_POW_DOWN,((1<<ports)<<10));
reg_write(SERDES_CLKMODE_REG,0x0);
reg_write(SERDES_CLKMODE_REG,0xf);
reg_write(0x505,0xf);
reg_write(0x505,0x0);
reg_write((PORT_ENABLE),0xF);
break;
default :
eprintf("Invalid parameters. \n");
return INVALID_PARAMETERS;
}
/* configure to send packets on all ports */
ports = 4;
pktptr = tx_data_pl;
pnum = ALL_PORT_PKT_SEQ_SZ/(4*4);
if (cflag)
{
iteration = 2;
exp_port_num = rxport[exp_port_num];
}
else
iteration = 4;
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)]);
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -