mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-11-30 07:34:12 +08:00
7aa55fcec2
This patch contains the following cleanups: - make needlessly global code static - remove the completely unused smtparse.c - remove the following unused global functions: - drvfbi.c: init_dma - drvfbi.c: dis_dma - drvfbi.c: get_rom_byte - drvfbi.c: mac_drv_vpd_read - drvfbi.c: mac_drv_pci_fix - fplustm.c: mac_set_func_addr - fplustm.c: mac_del_multicast - hwmtm.c: mac_drv_rx_frag - pcmplc.c: pcm_set_lct_short - smt.c: smt_please_reconnect - smt.c: smt_change_t_neg - smtdef.c: smt_set_defaults Signed-off-by: Adrian Bunk <bunk@stusta.de> Signed-off-by: Andrew Morton <akpm@osdl.org>
2190 lines
56 KiB
C
2190 lines
56 KiB
C
/******************************************************************************
|
|
*
|
|
* (C)Copyright 1998,1999 SysKonnect,
|
|
* a business unit of Schneider & Koch & Co. Datensysteme GmbH.
|
|
*
|
|
* See the file "skfddi.c" for further information.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* The information in this file is provided "AS IS" without warranty.
|
|
*
|
|
******************************************************************************/
|
|
|
|
#ifndef lint
|
|
static char const ID_sccs[] = "@(#)hwmtm.c 1.40 99/05/31 (C) SK" ;
|
|
#endif
|
|
|
|
#define HWMTM
|
|
|
|
#ifndef FDDI
|
|
#define FDDI
|
|
#endif
|
|
|
|
#include "h/types.h"
|
|
#include "h/fddi.h"
|
|
#include "h/smc.h"
|
|
#include "h/supern_2.h"
|
|
#include "h/skfbiinc.h"
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
DOCUMENTATION
|
|
-------------------------------------------------------------
|
|
BEGIN_MANUAL_ENTRY(DOCUMENTATION)
|
|
|
|
T B D
|
|
|
|
END_MANUAL_ENTRY
|
|
*/
|
|
/*
|
|
-------------------------------------------------------------
|
|
LOCAL VARIABLES:
|
|
-------------------------------------------------------------
|
|
*/
|
|
#ifdef COMMON_MB_POOL
|
|
static SMbuf *mb_start = 0 ;
|
|
static SMbuf *mb_free = 0 ;
|
|
static int mb_init = FALSE ;
|
|
static int call_count = 0 ;
|
|
#endif
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
EXTERNE VARIABLES:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
#ifdef DEBUG
|
|
#ifndef DEBUG_BRD
|
|
extern struct smt_debug debug ;
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef NDIS_OS2
|
|
extern u_char offDepth ;
|
|
extern u_char force_irq_pending ;
|
|
#endif
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
LOCAL FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
static void queue_llc_rx(struct s_smc *smc, SMbuf *mb);
|
|
static void smt_to_llc(struct s_smc *smc, SMbuf *mb);
|
|
static void init_txd_ring(struct s_smc *smc);
|
|
static void init_rxd_ring(struct s_smc *smc);
|
|
static void queue_txd_mb(struct s_smc *smc, SMbuf *mb);
|
|
static u_long init_descr_ring(struct s_smc *smc, union s_fp_descr volatile *start,
|
|
int count);
|
|
static u_long repair_txd_ring(struct s_smc *smc, struct s_smt_tx_queue *queue);
|
|
static u_long repair_rxd_ring(struct s_smc *smc, struct s_smt_rx_queue *queue);
|
|
static SMbuf* get_llc_rx(struct s_smc *smc);
|
|
static SMbuf* get_txd_mb(struct s_smc *smc);
|
|
static void mac_drv_clear_txd(struct s_smc *smc);
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
EXTERNAL FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
/* The external SMT functions are listed in cmtdef.h */
|
|
|
|
extern void* mac_drv_get_space(struct s_smc *smc, unsigned int size);
|
|
extern void* mac_drv_get_desc_mem(struct s_smc *smc, unsigned int size);
|
|
extern void init_board(struct s_smc *smc, u_char *mac_addr);
|
|
extern void mac_drv_fill_rxd(struct s_smc *smc);
|
|
extern void plc1_irq(struct s_smc *smc);
|
|
extern void mac_drv_tx_complete(struct s_smc *smc,
|
|
volatile struct s_smt_fp_txd *txd);
|
|
extern void plc2_irq(struct s_smc *smc);
|
|
extern void mac1_irq(struct s_smc *smc, u_short stu, u_short stl);
|
|
extern void mac2_irq(struct s_smc *smc, u_short code_s2u, u_short code_s2l);
|
|
extern void mac3_irq(struct s_smc *smc, u_short code_s3u, u_short code_s3l);
|
|
extern void timer_irq(struct s_smc *smc);
|
|
extern void mac_drv_rx_complete(struct s_smc *smc,
|
|
volatile struct s_smt_fp_rxd *rxd,
|
|
int frag_count, int len);
|
|
extern void mac_drv_requeue_rxd(struct s_smc *smc,
|
|
volatile struct s_smt_fp_rxd *rxd,
|
|
int frag_count);
|
|
extern void init_plc(struct s_smc *smc);
|
|
extern void mac_drv_clear_rxd(struct s_smc *smc,
|
|
volatile struct s_smt_fp_rxd *rxd, int frag_count);
|
|
|
|
#ifdef USE_OS_CPY
|
|
extern void hwm_cpy_rxd2mb(void);
|
|
extern void hwm_cpy_txd2mb(void);
|
|
#endif
|
|
|
|
#ifdef ALL_RX_COMPLETE
|
|
extern void mac_drv_all_receives_complete(void);
|
|
#endif
|
|
|
|
extern u_long mac_drv_virt2phys(struct s_smc *smc, void *virt);
|
|
extern u_long dma_master(struct s_smc *smc, void *virt, int len, int flag);
|
|
|
|
#ifdef NDIS_OS2
|
|
extern void post_proc(void);
|
|
#else
|
|
extern void dma_complete(struct s_smc *smc, volatile union s_fp_descr *descr,
|
|
int flag);
|
|
#endif
|
|
|
|
extern int init_fplus(struct s_smc *smc);
|
|
extern int mac_drv_rx_init(struct s_smc *smc, int len, int fc, char *look_ahead,
|
|
int la_len);
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
PUBLIC FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
void process_receive(struct s_smc *smc);
|
|
void fddi_isr(struct s_smc *smc);
|
|
void smt_free_mbuf(struct s_smc *smc, SMbuf *mb);
|
|
void init_driver_fplus(struct s_smc *smc);
|
|
void mac_drv_rx_mode(struct s_smc *smc, int mode);
|
|
void init_fddi_driver(struct s_smc *smc, u_char *mac_addr);
|
|
void mac_drv_clear_tx_queue(struct s_smc *smc);
|
|
void mac_drv_clear_rx_queue(struct s_smc *smc);
|
|
void hwm_tx_frag(struct s_smc *smc, char far *virt, u_long phys, int len,
|
|
int frame_status);
|
|
void hwm_rx_frag(struct s_smc *smc, char far *virt, u_long phys, int len,
|
|
int frame_status);
|
|
|
|
int mac_drv_init(struct s_smc *smc);
|
|
int hwm_tx_init(struct s_smc *smc, u_char fc, int frag_count, int frame_len,
|
|
int frame_status);
|
|
|
|
u_int mac_drv_check_space(void);
|
|
|
|
SMbuf* smt_get_mbuf(struct s_smc *smc);
|
|
|
|
#ifdef DEBUG
|
|
void mac_drv_debug_lev(void);
|
|
#endif
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
MACROS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
#ifndef UNUSED
|
|
#ifdef lint
|
|
#define UNUSED(x) (x) = (x)
|
|
#else
|
|
#define UNUSED(x)
|
|
#endif
|
|
#endif
|
|
|
|
#ifdef USE_CAN_ADDR
|
|
#define MA smc->hw.fddi_canon_addr.a
|
|
#define GROUP_ADDR_BIT 0x01
|
|
#else
|
|
#define MA smc->hw.fddi_home_addr.a
|
|
#define GROUP_ADDR_BIT 0x80
|
|
#endif
|
|
|
|
#define RXD_TXD_COUNT (HWM_ASYNC_TXD_COUNT+HWM_SYNC_TXD_COUNT+\
|
|
SMT_R1_RXD_COUNT+SMT_R2_RXD_COUNT)
|
|
|
|
#ifdef MB_OUTSIDE_SMC
|
|
#define EXT_VIRT_MEM ((RXD_TXD_COUNT+1)*sizeof(struct s_smt_fp_txd) +\
|
|
MAX_MBUF*sizeof(SMbuf))
|
|
#define EXT_VIRT_MEM_2 ((RXD_TXD_COUNT+1)*sizeof(struct s_smt_fp_txd))
|
|
#else
|
|
#define EXT_VIRT_MEM ((RXD_TXD_COUNT+1)*sizeof(struct s_smt_fp_txd))
|
|
#endif
|
|
|
|
/*
|
|
* define critical read for 16 Bit drivers
|
|
*/
|
|
#if defined(NDIS_OS2) || defined(ODI2)
|
|
#define CR_READ(var) ((var) & 0xffff0000 | ((var) & 0xffff))
|
|
#else
|
|
#define CR_READ(var) (u_long)(var)
|
|
#endif
|
|
|
|
#define IMASK_SLOW (IS_PLINT1 | IS_PLINT2 | IS_TIMINT | IS_TOKEN | \
|
|
IS_MINTR1 | IS_MINTR2 | IS_MINTR3 | IS_R1_P | \
|
|
IS_R1_C | IS_XA_C | IS_XS_C)
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
INIT- AND SMT FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(mac_drv_check_space)
|
|
* u_int mac_drv_check_space()
|
|
*
|
|
* function DOWNCALL (drvsr.c)
|
|
* This function calculates the needed non virtual
|
|
* memory for MBufs, RxD and TxD descriptors etc.
|
|
* needed by the driver.
|
|
*
|
|
* return u_int memory in bytes
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
u_int mac_drv_check_space(void)
|
|
{
|
|
#ifdef MB_OUTSIDE_SMC
|
|
#ifdef COMMON_MB_POOL
|
|
call_count++ ;
|
|
if (call_count == 1) {
|
|
return(EXT_VIRT_MEM) ;
|
|
}
|
|
else {
|
|
return(EXT_VIRT_MEM_2) ;
|
|
}
|
|
#else
|
|
return (EXT_VIRT_MEM) ;
|
|
#endif
|
|
#else
|
|
return (0) ;
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(mac_drv_init)
|
|
* void mac_drv_init(smc)
|
|
*
|
|
* function DOWNCALL (drvsr.c)
|
|
* In this function the hardware module allocates it's
|
|
* memory.
|
|
* The operating system dependent module should call
|
|
* mac_drv_init once, after the adatper is detected.
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
int mac_drv_init(struct s_smc *smc)
|
|
{
|
|
if (sizeof(struct s_smt_fp_rxd) % 16) {
|
|
SMT_PANIC(smc,HWM_E0001,HWM_E0001_MSG) ;
|
|
}
|
|
if (sizeof(struct s_smt_fp_txd) % 16) {
|
|
SMT_PANIC(smc,HWM_E0002,HWM_E0002_MSG) ;
|
|
}
|
|
|
|
/*
|
|
* get the required memory for the RxDs and TxDs
|
|
*/
|
|
if (!(smc->os.hwm.descr_p = (union s_fp_descr volatile *)
|
|
mac_drv_get_desc_mem(smc,(u_int)
|
|
(RXD_TXD_COUNT+1)*sizeof(struct s_smt_fp_txd)))) {
|
|
return(1) ; /* no space the hwm modul can't work */
|
|
}
|
|
|
|
/*
|
|
* get the memory for the SMT MBufs
|
|
*/
|
|
#ifndef MB_OUTSIDE_SMC
|
|
smc->os.hwm.mbuf_pool.mb_start=(SMbuf *)(&smc->os.hwm.mbuf_pool.mb[0]) ;
|
|
#else
|
|
#ifndef COMMON_MB_POOL
|
|
if (!(smc->os.hwm.mbuf_pool.mb_start = (SMbuf *) mac_drv_get_space(smc,
|
|
MAX_MBUF*sizeof(SMbuf)))) {
|
|
return(1) ; /* no space the hwm modul can't work */
|
|
}
|
|
#else
|
|
if (!mb_start) {
|
|
if (!(mb_start = (SMbuf *) mac_drv_get_space(smc,
|
|
MAX_MBUF*sizeof(SMbuf)))) {
|
|
return(1) ; /* no space the hwm modul can't work */
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
return (0) ;
|
|
}
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(init_driver_fplus)
|
|
* init_driver_fplus(smc)
|
|
*
|
|
* Sets hardware modul specific values for the mode register 2
|
|
* (e.g. the byte alignment for the received frames, the position of the
|
|
* least significant byte etc.)
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void init_driver_fplus(struct s_smc *smc)
|
|
{
|
|
smc->hw.fp.mdr2init = FM_LSB | FM_BMMODE | FM_ENNPRQ | FM_ENHSRQ | 3 ;
|
|
|
|
#ifdef PCI
|
|
smc->hw.fp.mdr2init |= FM_CHKPAR | FM_PARITY ;
|
|
#endif
|
|
smc->hw.fp.mdr3init = FM_MENRQAUNLCK | FM_MENRS ;
|
|
|
|
#ifdef USE_CAN_ADDR
|
|
/* enable address bit swapping */
|
|
smc->hw.fp.frselreg_init = FM_ENXMTADSWAP | FM_ENRCVADSWAP ;
|
|
#endif
|
|
}
|
|
|
|
static u_long init_descr_ring(struct s_smc *smc,
|
|
union s_fp_descr volatile *start,
|
|
int count)
|
|
{
|
|
int i ;
|
|
union s_fp_descr volatile *d1 ;
|
|
union s_fp_descr volatile *d2 ;
|
|
u_long phys ;
|
|
|
|
DB_GEN("descr ring starts at = %x ",(void *)start,0,3) ;
|
|
for (i=count-1, d1=start; i ; i--) {
|
|
d2 = d1 ;
|
|
d1++ ; /* descr is owned by the host */
|
|
d2->r.rxd_rbctrl = AIX_REVERSE(BMU_CHECK) ;
|
|
d2->r.rxd_next = &d1->r ;
|
|
phys = mac_drv_virt2phys(smc,(void *)d1) ;
|
|
d2->r.rxd_nrdadr = AIX_REVERSE(phys) ;
|
|
}
|
|
DB_GEN("descr ring ends at = %x ",(void *)d1,0,3) ;
|
|
d1->r.rxd_rbctrl = AIX_REVERSE(BMU_CHECK) ;
|
|
d1->r.rxd_next = &start->r ;
|
|
phys = mac_drv_virt2phys(smc,(void *)start) ;
|
|
d1->r.rxd_nrdadr = AIX_REVERSE(phys) ;
|
|
|
|
for (i=count, d1=start; i ; i--) {
|
|
DRV_BUF_FLUSH(&d1->r,DDI_DMA_SYNC_FORDEV) ;
|
|
d1++;
|
|
}
|
|
return(phys) ;
|
|
}
|
|
|
|
static void init_txd_ring(struct s_smc *smc)
|
|
{
|
|
struct s_smt_fp_txd volatile *ds ;
|
|
struct s_smt_tx_queue *queue ;
|
|
u_long phys ;
|
|
|
|
/*
|
|
* initialize the transmit descriptors
|
|
*/
|
|
ds = (struct s_smt_fp_txd volatile *) ((char *)smc->os.hwm.descr_p +
|
|
SMT_R1_RXD_COUNT*sizeof(struct s_smt_fp_rxd)) ;
|
|
queue = smc->hw.fp.tx[QUEUE_A0] ;
|
|
DB_GEN("Init async TxD ring, %d TxDs ",HWM_ASYNC_TXD_COUNT,0,3) ;
|
|
(void)init_descr_ring(smc,(union s_fp_descr volatile *)ds,
|
|
HWM_ASYNC_TXD_COUNT) ;
|
|
phys = AIX_REVERSE(ds->txd_ntdadr) ;
|
|
ds++ ;
|
|
queue->tx_curr_put = queue->tx_curr_get = ds ;
|
|
ds-- ;
|
|
queue->tx_free = HWM_ASYNC_TXD_COUNT ;
|
|
queue->tx_used = 0 ;
|
|
outpd(ADDR(B5_XA_DA),phys) ;
|
|
|
|
ds = (struct s_smt_fp_txd volatile *) ((char *)ds +
|
|
HWM_ASYNC_TXD_COUNT*sizeof(struct s_smt_fp_txd)) ;
|
|
queue = smc->hw.fp.tx[QUEUE_S] ;
|
|
DB_GEN("Init sync TxD ring, %d TxDs ",HWM_SYNC_TXD_COUNT,0,3) ;
|
|
(void)init_descr_ring(smc,(union s_fp_descr volatile *)ds,
|
|
HWM_SYNC_TXD_COUNT) ;
|
|
phys = AIX_REVERSE(ds->txd_ntdadr) ;
|
|
ds++ ;
|
|
queue->tx_curr_put = queue->tx_curr_get = ds ;
|
|
queue->tx_free = HWM_SYNC_TXD_COUNT ;
|
|
queue->tx_used = 0 ;
|
|
outpd(ADDR(B5_XS_DA),phys) ;
|
|
}
|
|
|
|
static void init_rxd_ring(struct s_smc *smc)
|
|
{
|
|
struct s_smt_fp_rxd volatile *ds ;
|
|
struct s_smt_rx_queue *queue ;
|
|
u_long phys ;
|
|
|
|
/*
|
|
* initialize the receive descriptors
|
|
*/
|
|
ds = (struct s_smt_fp_rxd volatile *) smc->os.hwm.descr_p ;
|
|
queue = smc->hw.fp.rx[QUEUE_R1] ;
|
|
DB_GEN("Init RxD ring, %d RxDs ",SMT_R1_RXD_COUNT,0,3) ;
|
|
(void)init_descr_ring(smc,(union s_fp_descr volatile *)ds,
|
|
SMT_R1_RXD_COUNT) ;
|
|
phys = AIX_REVERSE(ds->rxd_nrdadr) ;
|
|
ds++ ;
|
|
queue->rx_curr_put = queue->rx_curr_get = ds ;
|
|
queue->rx_free = SMT_R1_RXD_COUNT ;
|
|
queue->rx_used = 0 ;
|
|
outpd(ADDR(B4_R1_DA),phys) ;
|
|
}
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(init_fddi_driver)
|
|
* void init_fddi_driver(smc,mac_addr)
|
|
*
|
|
* initializes the driver and it's variables
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void init_fddi_driver(struct s_smc *smc, u_char *mac_addr)
|
|
{
|
|
SMbuf *mb ;
|
|
int i ;
|
|
|
|
init_board(smc,mac_addr) ;
|
|
(void)init_fplus(smc) ;
|
|
|
|
/*
|
|
* initialize the SMbufs for the SMT
|
|
*/
|
|
#ifndef COMMON_MB_POOL
|
|
mb = smc->os.hwm.mbuf_pool.mb_start ;
|
|
smc->os.hwm.mbuf_pool.mb_free = (SMbuf *)NULL ;
|
|
for (i = 0; i < MAX_MBUF; i++) {
|
|
mb->sm_use_count = 1 ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
mb++ ;
|
|
}
|
|
#else
|
|
mb = mb_start ;
|
|
if (!mb_init) {
|
|
mb_free = 0 ;
|
|
for (i = 0; i < MAX_MBUF; i++) {
|
|
mb->sm_use_count = 1 ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
mb++ ;
|
|
}
|
|
mb_init = TRUE ;
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* initialize the other variables
|
|
*/
|
|
smc->os.hwm.llc_rx_pipe = smc->os.hwm.llc_rx_tail = (SMbuf *)NULL ;
|
|
smc->os.hwm.txd_tx_pipe = smc->os.hwm.txd_tx_tail = NULL ;
|
|
smc->os.hwm.pass_SMT = smc->os.hwm.pass_NSA = smc->os.hwm.pass_DB = 0 ;
|
|
smc->os.hwm.pass_llc_promisc = TRUE ;
|
|
smc->os.hwm.queued_rx_frames = smc->os.hwm.queued_txd_mb = 0 ;
|
|
smc->os.hwm.detec_count = 0 ;
|
|
smc->os.hwm.rx_break = 0 ;
|
|
smc->os.hwm.rx_len_error = 0 ;
|
|
smc->os.hwm.isr_flag = FALSE ;
|
|
|
|
/*
|
|
* make sure that the start pointer is 16 byte aligned
|
|
*/
|
|
i = 16 - ((long)smc->os.hwm.descr_p & 0xf) ;
|
|
if (i != 16) {
|
|
DB_GEN("i = %d",i,0,3) ;
|
|
smc->os.hwm.descr_p = (union s_fp_descr volatile *)
|
|
((char *)smc->os.hwm.descr_p+i) ;
|
|
}
|
|
DB_GEN("pt to descr area = %x",(void *)smc->os.hwm.descr_p,0,3) ;
|
|
|
|
init_txd_ring(smc) ;
|
|
init_rxd_ring(smc) ;
|
|
mac_drv_fill_rxd(smc) ;
|
|
|
|
init_plc(smc) ;
|
|
}
|
|
|
|
|
|
SMbuf *smt_get_mbuf(struct s_smc *smc)
|
|
{
|
|
register SMbuf *mb ;
|
|
|
|
#ifndef COMMON_MB_POOL
|
|
mb = smc->os.hwm.mbuf_pool.mb_free ;
|
|
#else
|
|
mb = mb_free ;
|
|
#endif
|
|
if (mb) {
|
|
#ifndef COMMON_MB_POOL
|
|
smc->os.hwm.mbuf_pool.mb_free = mb->sm_next ;
|
|
#else
|
|
mb_free = mb->sm_next ;
|
|
#endif
|
|
mb->sm_off = 8 ;
|
|
mb->sm_use_count = 1 ;
|
|
}
|
|
DB_GEN("get SMbuf: mb = %x",(void *)mb,0,3) ;
|
|
return (mb) ; /* May be NULL */
|
|
}
|
|
|
|
void smt_free_mbuf(struct s_smc *smc, SMbuf *mb)
|
|
{
|
|
|
|
if (mb) {
|
|
mb->sm_use_count-- ;
|
|
DB_GEN("free_mbuf: sm_use_count = %d",mb->sm_use_count,0,3) ;
|
|
/*
|
|
* If the use_count is != zero the MBuf is queued
|
|
* more than once and must not queued into the
|
|
* free MBuf queue
|
|
*/
|
|
if (!mb->sm_use_count) {
|
|
DB_GEN("free SMbuf: mb = %x",(void *)mb,0,3) ;
|
|
#ifndef COMMON_MB_POOL
|
|
mb->sm_next = smc->os.hwm.mbuf_pool.mb_free ;
|
|
smc->os.hwm.mbuf_pool.mb_free = mb ;
|
|
#else
|
|
mb->sm_next = mb_free ;
|
|
mb_free = mb ;
|
|
#endif
|
|
}
|
|
}
|
|
else
|
|
SMT_PANIC(smc,HWM_E0003,HWM_E0003_MSG) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(mac_drv_repair_descr)
|
|
* void mac_drv_repair_descr(smc)
|
|
*
|
|
* function called from SMT (HWM / hwmtm.c)
|
|
* The BMU is idle when this function is called.
|
|
* Mac_drv_repair_descr sets up the physical address
|
|
* for all receive and transmit queues where the BMU
|
|
* should continue.
|
|
* It may be that the BMU was reseted during a fragmented
|
|
* transfer. In this case there are some fragments which will
|
|
* never completed by the BMU. The OWN bit of this fragments
|
|
* must be switched to be owned by the host.
|
|
*
|
|
* Give a start command to the receive BMU.
|
|
* Start the transmit BMUs if transmit frames pending.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void mac_drv_repair_descr(struct s_smc *smc)
|
|
{
|
|
u_long phys ;
|
|
|
|
if (smc->hw.hw_state != STOPPED) {
|
|
SK_BREAK() ;
|
|
SMT_PANIC(smc,HWM_E0013,HWM_E0013_MSG) ;
|
|
return ;
|
|
}
|
|
|
|
/*
|
|
* repair tx queues: don't start
|
|
*/
|
|
phys = repair_txd_ring(smc,smc->hw.fp.tx[QUEUE_A0]) ;
|
|
outpd(ADDR(B5_XA_DA),phys) ;
|
|
if (smc->hw.fp.tx_q[QUEUE_A0].tx_used) {
|
|
outpd(ADDR(B0_XA_CSR),CSR_START) ;
|
|
}
|
|
phys = repair_txd_ring(smc,smc->hw.fp.tx[QUEUE_S]) ;
|
|
outpd(ADDR(B5_XS_DA),phys) ;
|
|
if (smc->hw.fp.tx_q[QUEUE_S].tx_used) {
|
|
outpd(ADDR(B0_XS_CSR),CSR_START) ;
|
|
}
|
|
|
|
/*
|
|
* repair rx queues
|
|
*/
|
|
phys = repair_rxd_ring(smc,smc->hw.fp.rx[QUEUE_R1]) ;
|
|
outpd(ADDR(B4_R1_DA),phys) ;
|
|
outpd(ADDR(B0_R1_CSR),CSR_START) ;
|
|
}
|
|
|
|
static u_long repair_txd_ring(struct s_smc *smc, struct s_smt_tx_queue *queue)
|
|
{
|
|
int i ;
|
|
int tx_used ;
|
|
u_long phys ;
|
|
u_long tbctrl ;
|
|
struct s_smt_fp_txd volatile *t ;
|
|
|
|
SK_UNUSED(smc) ;
|
|
|
|
t = queue->tx_curr_get ;
|
|
tx_used = queue->tx_used ;
|
|
for (i = tx_used+queue->tx_free-1 ; i ; i-- ) {
|
|
t = t->txd_next ;
|
|
}
|
|
phys = AIX_REVERSE(t->txd_ntdadr) ;
|
|
|
|
t = queue->tx_curr_get ;
|
|
while (tx_used) {
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORCPU) ;
|
|
tbctrl = AIX_REVERSE(t->txd_tbctrl) ;
|
|
|
|
if (tbctrl & BMU_OWN) {
|
|
if (tbctrl & BMU_STF) {
|
|
break ; /* exit the loop */
|
|
}
|
|
else {
|
|
/*
|
|
* repair the descriptor
|
|
*/
|
|
t->txd_tbctrl &= AIX_REVERSE(~BMU_OWN) ;
|
|
}
|
|
}
|
|
phys = AIX_REVERSE(t->txd_ntdadr) ;
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
t = t->txd_next ;
|
|
tx_used-- ;
|
|
}
|
|
return(phys) ;
|
|
}
|
|
|
|
/*
|
|
* Repairs the receive descriptor ring and returns the physical address
|
|
* where the BMU should continue working.
|
|
*
|
|
* o The physical address where the BMU was stopped has to be
|
|
* determined. This is the next RxD after rx_curr_get with an OWN
|
|
* bit set.
|
|
* o The BMU should start working at beginning of the next frame.
|
|
* RxDs with an OWN bit set but with a reset STF bit should be
|
|
* skipped and owned by the driver (OWN = 0).
|
|
*/
|
|
static u_long repair_rxd_ring(struct s_smc *smc, struct s_smt_rx_queue *queue)
|
|
{
|
|
int i ;
|
|
int rx_used ;
|
|
u_long phys ;
|
|
u_long rbctrl ;
|
|
struct s_smt_fp_rxd volatile *r ;
|
|
|
|
SK_UNUSED(smc) ;
|
|
|
|
r = queue->rx_curr_get ;
|
|
rx_used = queue->rx_used ;
|
|
for (i = SMT_R1_RXD_COUNT-1 ; i ; i-- ) {
|
|
r = r->rxd_next ;
|
|
}
|
|
phys = AIX_REVERSE(r->rxd_nrdadr) ;
|
|
|
|
r = queue->rx_curr_get ;
|
|
while (rx_used) {
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
rbctrl = AIX_REVERSE(r->rxd_rbctrl) ;
|
|
|
|
if (rbctrl & BMU_OWN) {
|
|
if (rbctrl & BMU_STF) {
|
|
break ; /* exit the loop */
|
|
}
|
|
else {
|
|
/*
|
|
* repair the descriptor
|
|
*/
|
|
r->rxd_rbctrl &= AIX_REVERSE(~BMU_OWN) ;
|
|
}
|
|
}
|
|
phys = AIX_REVERSE(r->rxd_nrdadr) ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORDEV) ;
|
|
r = r->rxd_next ;
|
|
rx_used-- ;
|
|
}
|
|
return(phys) ;
|
|
}
|
|
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
INTERRUPT SERVICE ROUTINE:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(fddi_isr)
|
|
* void fddi_isr(smc)
|
|
*
|
|
* function DOWNCALL (drvsr.c)
|
|
* interrupt service routine, handles the interrupt requests
|
|
* generated by the FDDI adapter.
|
|
*
|
|
* NOTE: The operating system dependent module must garantee that the
|
|
* interrupts of the adapter are disabled when it calls fddi_isr.
|
|
*
|
|
* About the USE_BREAK_ISR mechanismn:
|
|
*
|
|
* The main requirement of this mechanismn is to force an timer IRQ when
|
|
* leaving process_receive() with leave_isr set. process_receive() may
|
|
* be called at any time from anywhere!
|
|
* To be sure we don't miss such event we set 'force_irq' per default.
|
|
* We have to force and Timer IRQ if 'smc->os.hwm.leave_isr' AND
|
|
* 'force_irq' are set. 'force_irq' may be reset if a receive complete
|
|
* IRQ is pending.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void fddi_isr(struct s_smc *smc)
|
|
{
|
|
u_long is ; /* ISR source */
|
|
u_short stu, stl ;
|
|
SMbuf *mb ;
|
|
|
|
#ifdef USE_BREAK_ISR
|
|
int force_irq ;
|
|
#endif
|
|
|
|
#ifdef ODI2
|
|
if (smc->os.hwm.rx_break) {
|
|
mac_drv_fill_rxd(smc) ;
|
|
if (smc->hw.fp.rx_q[QUEUE_R1].rx_used > 0) {
|
|
smc->os.hwm.rx_break = 0 ;
|
|
process_receive(smc) ;
|
|
}
|
|
else {
|
|
smc->os.hwm.detec_count = 0 ;
|
|
smt_force_irq(smc) ;
|
|
}
|
|
}
|
|
#endif
|
|
smc->os.hwm.isr_flag = TRUE ;
|
|
|
|
#ifdef USE_BREAK_ISR
|
|
force_irq = TRUE ;
|
|
if (smc->os.hwm.leave_isr) {
|
|
smc->os.hwm.leave_isr = FALSE ;
|
|
process_receive(smc) ;
|
|
}
|
|
#endif
|
|
|
|
while ((is = GET_ISR() & ISR_MASK)) {
|
|
NDD_TRACE("CH0B",is,0,0) ;
|
|
DB_GEN("ISA = 0x%x",is,0,7) ;
|
|
|
|
if (is & IMASK_SLOW) {
|
|
NDD_TRACE("CH1b",is,0,0) ;
|
|
if (is & IS_PLINT1) { /* PLC1 */
|
|
plc1_irq(smc) ;
|
|
}
|
|
if (is & IS_PLINT2) { /* PLC2 */
|
|
plc2_irq(smc) ;
|
|
}
|
|
if (is & IS_MINTR1) { /* FORMAC+ STU1(U/L) */
|
|
stu = inpw(FM_A(FM_ST1U)) ;
|
|
stl = inpw(FM_A(FM_ST1L)) ;
|
|
DB_GEN("Slow transmit complete",0,0,6) ;
|
|
mac1_irq(smc,stu,stl) ;
|
|
}
|
|
if (is & IS_MINTR2) { /* FORMAC+ STU2(U/L) */
|
|
stu= inpw(FM_A(FM_ST2U)) ;
|
|
stl= inpw(FM_A(FM_ST2L)) ;
|
|
DB_GEN("Slow receive complete",0,0,6) ;
|
|
DB_GEN("stl = %x : stu = %x",stl,stu,7) ;
|
|
mac2_irq(smc,stu,stl) ;
|
|
}
|
|
if (is & IS_MINTR3) { /* FORMAC+ STU3(U/L) */
|
|
stu= inpw(FM_A(FM_ST3U)) ;
|
|
stl= inpw(FM_A(FM_ST3L)) ;
|
|
DB_GEN("FORMAC Mode Register 3",0,0,6) ;
|
|
mac3_irq(smc,stu,stl) ;
|
|
}
|
|
if (is & IS_TIMINT) { /* Timer 82C54-2 */
|
|
timer_irq(smc) ;
|
|
#ifdef NDIS_OS2
|
|
force_irq_pending = 0 ;
|
|
#endif
|
|
/*
|
|
* out of RxD detection
|
|
*/
|
|
if (++smc->os.hwm.detec_count > 4) {
|
|
/*
|
|
* check out of RxD condition
|
|
*/
|
|
process_receive(smc) ;
|
|
}
|
|
}
|
|
if (is & IS_TOKEN) { /* Restricted Token Monitor */
|
|
rtm_irq(smc) ;
|
|
}
|
|
if (is & IS_R1_P) { /* Parity error rx queue 1 */
|
|
/* clear IRQ */
|
|
outpd(ADDR(B4_R1_CSR),CSR_IRQ_CL_P) ;
|
|
SMT_PANIC(smc,HWM_E0004,HWM_E0004_MSG) ;
|
|
}
|
|
if (is & IS_R1_C) { /* Encoding error rx queue 1 */
|
|
/* clear IRQ */
|
|
outpd(ADDR(B4_R1_CSR),CSR_IRQ_CL_C) ;
|
|
SMT_PANIC(smc,HWM_E0005,HWM_E0005_MSG) ;
|
|
}
|
|
if (is & IS_XA_C) { /* Encoding error async tx q */
|
|
/* clear IRQ */
|
|
outpd(ADDR(B5_XA_CSR),CSR_IRQ_CL_C) ;
|
|
SMT_PANIC(smc,HWM_E0006,HWM_E0006_MSG) ;
|
|
}
|
|
if (is & IS_XS_C) { /* Encoding error sync tx q */
|
|
/* clear IRQ */
|
|
outpd(ADDR(B5_XS_CSR),CSR_IRQ_CL_C) ;
|
|
SMT_PANIC(smc,HWM_E0007,HWM_E0007_MSG) ;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Fast Tx complete Async/Sync Queue (BMU service)
|
|
*/
|
|
if (is & (IS_XS_F|IS_XA_F)) {
|
|
DB_GEN("Fast tx complete queue",0,0,6) ;
|
|
/*
|
|
* clear IRQ, Note: no IRQ is lost, because
|
|
* we always service both queues
|
|
*/
|
|
outpd(ADDR(B5_XS_CSR),CSR_IRQ_CL_F) ;
|
|
outpd(ADDR(B5_XA_CSR),CSR_IRQ_CL_F) ;
|
|
mac_drv_clear_txd(smc) ;
|
|
llc_restart_tx(smc) ;
|
|
}
|
|
|
|
/*
|
|
* Fast Rx Complete (BMU service)
|
|
*/
|
|
if (is & IS_R1_F) {
|
|
DB_GEN("Fast receive complete",0,0,6) ;
|
|
/* clear IRQ */
|
|
#ifndef USE_BREAK_ISR
|
|
outpd(ADDR(B4_R1_CSR),CSR_IRQ_CL_F) ;
|
|
process_receive(smc) ;
|
|
#else
|
|
process_receive(smc) ;
|
|
if (smc->os.hwm.leave_isr) {
|
|
force_irq = FALSE ;
|
|
} else {
|
|
outpd(ADDR(B4_R1_CSR),CSR_IRQ_CL_F) ;
|
|
process_receive(smc) ;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#ifndef NDIS_OS2
|
|
while ((mb = get_llc_rx(smc))) {
|
|
smt_to_llc(smc,mb) ;
|
|
}
|
|
#else
|
|
if (offDepth)
|
|
post_proc() ;
|
|
|
|
while (!offDepth && (mb = get_llc_rx(smc))) {
|
|
smt_to_llc(smc,mb) ;
|
|
}
|
|
|
|
if (!offDepth && smc->os.hwm.rx_break) {
|
|
process_receive(smc) ;
|
|
}
|
|
#endif
|
|
if (smc->q.ev_get != smc->q.ev_put) {
|
|
NDD_TRACE("CH2a",0,0,0) ;
|
|
ev_dispatcher(smc) ;
|
|
}
|
|
#ifdef NDIS_OS2
|
|
post_proc() ;
|
|
if (offDepth) { /* leave fddi_isr because */
|
|
break ; /* indications not allowed */
|
|
}
|
|
#endif
|
|
#ifdef USE_BREAK_ISR
|
|
if (smc->os.hwm.leave_isr) {
|
|
break ; /* leave fddi_isr */
|
|
}
|
|
#endif
|
|
|
|
/* NOTE: when the isr is left, no rx is pending */
|
|
} /* end of interrupt source polling loop */
|
|
|
|
#ifdef USE_BREAK_ISR
|
|
if (smc->os.hwm.leave_isr && force_irq) {
|
|
smt_force_irq(smc) ;
|
|
}
|
|
#endif
|
|
smc->os.hwm.isr_flag = FALSE ;
|
|
NDD_TRACE("CH0E",0,0,0) ;
|
|
}
|
|
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
RECEIVE FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
#ifndef NDIS_OS2
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(mac_drv_rx_mode)
|
|
* void mac_drv_rx_mode(smc,mode)
|
|
*
|
|
* function DOWNCALL (fplus.c)
|
|
* Corresponding to the parameter mode, the operating system
|
|
* dependent module can activate several receive modes.
|
|
*
|
|
* para mode = 1: RX_ENABLE_ALLMULTI enable all multicasts
|
|
* = 2: RX_DISABLE_ALLMULTI disable "enable all multicasts"
|
|
* = 3: RX_ENABLE_PROMISC enable promiscuous
|
|
* = 4: RX_DISABLE_PROMISC disable promiscuous
|
|
* = 5: RX_ENABLE_NSA enable rec. of all NSA frames
|
|
* (disabled after 'driver reset' & 'set station address')
|
|
* = 6: RX_DISABLE_NSA disable rec. of all NSA frames
|
|
*
|
|
* = 21: RX_ENABLE_PASS_SMT ( see description )
|
|
* = 22: RX_DISABLE_PASS_SMT ( " " )
|
|
* = 23: RX_ENABLE_PASS_NSA ( " " )
|
|
* = 24: RX_DISABLE_PASS_NSA ( " " )
|
|
* = 25: RX_ENABLE_PASS_DB ( " " )
|
|
* = 26: RX_DISABLE_PASS_DB ( " " )
|
|
* = 27: RX_DISABLE_PASS_ALL ( " " )
|
|
* = 28: RX_DISABLE_LLC_PROMISC ( " " )
|
|
* = 29: RX_ENABLE_LLC_PROMISC ( " " )
|
|
*
|
|
*
|
|
* RX_ENABLE_PASS_SMT / RX_DISABLE_PASS_SMT
|
|
*
|
|
* If the operating system dependent module activates the
|
|
* mode RX_ENABLE_PASS_SMT, the hardware module
|
|
* duplicates all SMT frames with the frame control
|
|
* FC_SMT_INFO and passes them to the LLC receive channel
|
|
* by calling mac_drv_rx_init.
|
|
* The SMT Frames which are sent by the local SMT and the NSA
|
|
* frames whose A- and C-Indicator is not set are also duplicated
|
|
* and passed.
|
|
* The receive mode RX_DISABLE_PASS_SMT disables the passing
|
|
* of SMT frames.
|
|
*
|
|
* RX_ENABLE_PASS_NSA / RX_DISABLE_PASS_NSA
|
|
*
|
|
* If the operating system dependent module activates the
|
|
* mode RX_ENABLE_PASS_NSA, the hardware module
|
|
* duplicates all NSA frames with frame control FC_SMT_NSA
|
|
* and a set A-Indicator and passed them to the LLC
|
|
* receive channel by calling mac_drv_rx_init.
|
|
* All NSA Frames which are sent by the local SMT
|
|
* are also duplicated and passed.
|
|
* The receive mode RX_DISABLE_PASS_NSA disables the passing
|
|
* of NSA frames with the A- or C-Indicator set.
|
|
*
|
|
* NOTE: For fear that the hardware module receives NSA frames with
|
|
* a reset A-Indicator, the operating system dependent module
|
|
* has to call mac_drv_rx_mode with the mode RX_ENABLE_NSA
|
|
* before activate the RX_ENABLE_PASS_NSA mode and after every
|
|
* 'driver reset' and 'set station address'.
|
|
*
|
|
* RX_ENABLE_PASS_DB / RX_DISABLE_PASS_DB
|
|
*
|
|
* If the operating system dependent module activates the
|
|
* mode RX_ENABLE_PASS_DB, direct BEACON frames
|
|
* (FC_BEACON frame control) are passed to the LLC receive
|
|
* channel by mac_drv_rx_init.
|
|
* The receive mode RX_DISABLE_PASS_DB disables the passing
|
|
* of direct BEACON frames.
|
|
*
|
|
* RX_DISABLE_PASS_ALL
|
|
*
|
|
* Disables all special receives modes. It is equal to
|
|
* call mac_drv_set_rx_mode successively with the
|
|
* parameters RX_DISABLE_NSA, RX_DISABLE_PASS_SMT,
|
|
* RX_DISABLE_PASS_NSA and RX_DISABLE_PASS_DB.
|
|
*
|
|
* RX_ENABLE_LLC_PROMISC
|
|
*
|
|
* (default) all received LLC frames and all SMT/NSA/DBEACON
|
|
* frames depending on the attitude of the flags
|
|
* PASS_SMT/PASS_NSA/PASS_DBEACON will be delivered to the
|
|
* LLC layer
|
|
*
|
|
* RX_DISABLE_LLC_PROMISC
|
|
*
|
|
* all received SMT/NSA/DBEACON frames depending on the
|
|
* attitude of the flags PASS_SMT/PASS_NSA/PASS_DBEACON
|
|
* will be delivered to the LLC layer.
|
|
* all received LLC frames with a directed address, Multicast
|
|
* or Broadcast address will be delivered to the LLC
|
|
* layer too.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void mac_drv_rx_mode(struct s_smc *smc, int mode)
|
|
{
|
|
switch(mode) {
|
|
case RX_ENABLE_PASS_SMT:
|
|
smc->os.hwm.pass_SMT = TRUE ;
|
|
break ;
|
|
case RX_DISABLE_PASS_SMT:
|
|
smc->os.hwm.pass_SMT = FALSE ;
|
|
break ;
|
|
case RX_ENABLE_PASS_NSA:
|
|
smc->os.hwm.pass_NSA = TRUE ;
|
|
break ;
|
|
case RX_DISABLE_PASS_NSA:
|
|
smc->os.hwm.pass_NSA = FALSE ;
|
|
break ;
|
|
case RX_ENABLE_PASS_DB:
|
|
smc->os.hwm.pass_DB = TRUE ;
|
|
break ;
|
|
case RX_DISABLE_PASS_DB:
|
|
smc->os.hwm.pass_DB = FALSE ;
|
|
break ;
|
|
case RX_DISABLE_PASS_ALL:
|
|
smc->os.hwm.pass_SMT = smc->os.hwm.pass_NSA = FALSE ;
|
|
smc->os.hwm.pass_DB = FALSE ;
|
|
smc->os.hwm.pass_llc_promisc = TRUE ;
|
|
mac_set_rx_mode(smc,RX_DISABLE_NSA) ;
|
|
break ;
|
|
case RX_DISABLE_LLC_PROMISC:
|
|
smc->os.hwm.pass_llc_promisc = FALSE ;
|
|
break ;
|
|
case RX_ENABLE_LLC_PROMISC:
|
|
smc->os.hwm.pass_llc_promisc = TRUE ;
|
|
break ;
|
|
case RX_ENABLE_ALLMULTI:
|
|
case RX_DISABLE_ALLMULTI:
|
|
case RX_ENABLE_PROMISC:
|
|
case RX_DISABLE_PROMISC:
|
|
case RX_ENABLE_NSA:
|
|
case RX_DISABLE_NSA:
|
|
default:
|
|
mac_set_rx_mode(smc,mode) ;
|
|
break ;
|
|
}
|
|
}
|
|
#endif /* ifndef NDIS_OS2 */
|
|
|
|
/*
|
|
* process receive queue
|
|
*/
|
|
void process_receive(struct s_smc *smc)
|
|
{
|
|
int i ;
|
|
int n ;
|
|
int frag_count ; /* number of RxDs of the curr rx buf */
|
|
int used_frags ; /* number of RxDs of the curr frame */
|
|
struct s_smt_rx_queue *queue ; /* points to the queue ctl struct */
|
|
struct s_smt_fp_rxd volatile *r ; /* rxd pointer */
|
|
struct s_smt_fp_rxd volatile *rxd ; /* first rxd of rx frame */
|
|
u_long rbctrl ; /* receive buffer control word */
|
|
u_long rfsw ; /* receive frame status word */
|
|
u_short rx_used ;
|
|
u_char far *virt ;
|
|
char far *data ;
|
|
SMbuf *mb ;
|
|
u_char fc ; /* Frame control */
|
|
int len ; /* Frame length */
|
|
|
|
smc->os.hwm.detec_count = 0 ;
|
|
queue = smc->hw.fp.rx[QUEUE_R1] ;
|
|
NDD_TRACE("RHxB",0,0,0) ;
|
|
for ( ; ; ) {
|
|
r = queue->rx_curr_get ;
|
|
rx_used = queue->rx_used ;
|
|
frag_count = 0 ;
|
|
|
|
#ifdef USE_BREAK_ISR
|
|
if (smc->os.hwm.leave_isr) {
|
|
goto rx_end ;
|
|
}
|
|
#endif
|
|
#ifdef NDIS_OS2
|
|
if (offDepth) {
|
|
smc->os.hwm.rx_break = 1 ;
|
|
goto rx_end ;
|
|
}
|
|
smc->os.hwm.rx_break = 0 ;
|
|
#endif
|
|
#ifdef ODI2
|
|
if (smc->os.hwm.rx_break) {
|
|
goto rx_end ;
|
|
}
|
|
#endif
|
|
n = 0 ;
|
|
do {
|
|
DB_RX("Check RxD %x for OWN and EOF",(void *)r,0,5) ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
rbctrl = CR_READ(r->rxd_rbctrl) ;
|
|
rbctrl = AIX_REVERSE(rbctrl) ;
|
|
|
|
if (rbctrl & BMU_OWN) {
|
|
NDD_TRACE("RHxE",r,rfsw,rbctrl) ;
|
|
DB_RX("End of RxDs",0,0,4) ;
|
|
goto rx_end ;
|
|
}
|
|
/*
|
|
* out of RxD detection
|
|
*/
|
|
if (!rx_used) {
|
|
SK_BREAK() ;
|
|
SMT_PANIC(smc,HWM_E0009,HWM_E0009_MSG) ;
|
|
/* Either we don't have an RxD or all
|
|
* RxDs are filled. Therefore it's allowed
|
|
* for to set the STOPPED flag */
|
|
smc->hw.hw_state = STOPPED ;
|
|
mac_drv_clear_rx_queue(smc) ;
|
|
smc->hw.hw_state = STARTED ;
|
|
mac_drv_fill_rxd(smc) ;
|
|
smc->os.hwm.detec_count = 0 ;
|
|
goto rx_end ;
|
|
}
|
|
rfsw = AIX_REVERSE(r->rxd_rfsw) ;
|
|
if ((rbctrl & BMU_STF) != ((rbctrl & BMU_ST_BUF) <<5)) {
|
|
/*
|
|
* The BMU_STF bit is deleted, 1 frame is
|
|
* placed into more than 1 rx buffer
|
|
*
|
|
* skip frame by setting the rx len to 0
|
|
*
|
|
* if fragment count == 0
|
|
* The missing STF bit belongs to the
|
|
* current frame, search for the
|
|
* EOF bit to complete the frame
|
|
* else
|
|
* the fragment belongs to the next frame,
|
|
* exit the loop and process the frame
|
|
*/
|
|
SK_BREAK() ;
|
|
rfsw = 0 ;
|
|
if (frag_count) {
|
|
break ;
|
|
}
|
|
}
|
|
n += rbctrl & 0xffff ;
|
|
r = r->rxd_next ;
|
|
frag_count++ ;
|
|
rx_used-- ;
|
|
} while (!(rbctrl & BMU_EOF)) ;
|
|
used_frags = frag_count ;
|
|
DB_RX("EOF set in RxD, used_frags = %d ",used_frags,0,5) ;
|
|
|
|
/* may be next 2 DRV_BUF_FLUSH() can be skipped, because */
|
|
/* BMU_ST_BUF will not be changed by the ASIC */
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
while (rx_used && !(r->rxd_rbctrl & AIX_REVERSE(BMU_ST_BUF))) {
|
|
DB_RX("Check STF bit in %x",(void *)r,0,5) ;
|
|
r = r->rxd_next ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
frag_count++ ;
|
|
rx_used-- ;
|
|
}
|
|
DB_RX("STF bit found",0,0,5) ;
|
|
|
|
/*
|
|
* The received frame is finished for the process receive
|
|
*/
|
|
rxd = queue->rx_curr_get ;
|
|
queue->rx_curr_get = r ;
|
|
queue->rx_free += frag_count ;
|
|
queue->rx_used = rx_used ;
|
|
|
|
/*
|
|
* ASIC Errata no. 7 (STF - Bit Bug)
|
|
*/
|
|
rxd->rxd_rbctrl &= AIX_REVERSE(~BMU_STF) ;
|
|
|
|
for (r=rxd, i=frag_count ; i ; r=r->rxd_next, i--){
|
|
DB_RX("dma_complete for RxD %x",(void *)r,0,5) ;
|
|
dma_complete(smc,(union s_fp_descr volatile *)r,DMA_WR);
|
|
}
|
|
smc->hw.fp.err_stats.err_valid++ ;
|
|
smc->mib.m[MAC0].fddiMACCopied_Ct++ ;
|
|
|
|
/* the length of the data including the FC */
|
|
len = (rfsw & RD_LENGTH) - 4 ;
|
|
|
|
DB_RX("frame length = %d",len,0,4) ;
|
|
/*
|
|
* check the frame_lenght and all error flags
|
|
*/
|
|
if (rfsw & (RX_MSRABT|RX_FS_E|RX_FS_CRC|RX_FS_IMPL)){
|
|
if (rfsw & RD_S_MSRABT) {
|
|
DB_RX("Frame aborted by the FORMAC",0,0,2) ;
|
|
smc->hw.fp.err_stats.err_abort++ ;
|
|
}
|
|
/*
|
|
* check frame status
|
|
*/
|
|
if (rfsw & RD_S_SEAC2) {
|
|
DB_RX("E-Indicator set",0,0,2) ;
|
|
smc->hw.fp.err_stats.err_e_indicator++ ;
|
|
}
|
|
if (rfsw & RD_S_SFRMERR) {
|
|
DB_RX("CRC error",0,0,2) ;
|
|
smc->hw.fp.err_stats.err_crc++ ;
|
|
}
|
|
if (rfsw & RX_FS_IMPL) {
|
|
DB_RX("Implementer frame",0,0,2) ;
|
|
smc->hw.fp.err_stats.err_imp_frame++ ;
|
|
}
|
|
goto abort_frame ;
|
|
}
|
|
if (len > FDDI_RAW_MTU-4) {
|
|
DB_RX("Frame too long error",0,0,2) ;
|
|
smc->hw.fp.err_stats.err_too_long++ ;
|
|
goto abort_frame ;
|
|
}
|
|
/*
|
|
* SUPERNET 3 Bug: FORMAC delivers status words
|
|
* of aborded frames to the BMU
|
|
*/
|
|
if (len <= 4) {
|
|
DB_RX("Frame length = 0",0,0,2) ;
|
|
goto abort_frame ;
|
|
}
|
|
|
|
if (len != (n-4)) {
|
|
DB_RX("BMU: rx len differs: [%d:%d]",len,n,4);
|
|
smc->os.hwm.rx_len_error++ ;
|
|
goto abort_frame ;
|
|
}
|
|
|
|
/*
|
|
* Check SA == MA
|
|
*/
|
|
virt = (u_char far *) rxd->rxd_virt ;
|
|
DB_RX("FC = %x",*virt,0,2) ;
|
|
if (virt[12] == MA[5] &&
|
|
virt[11] == MA[4] &&
|
|
virt[10] == MA[3] &&
|
|
virt[9] == MA[2] &&
|
|
virt[8] == MA[1] &&
|
|
(virt[7] & ~GROUP_ADDR_BIT) == MA[0]) {
|
|
goto abort_frame ;
|
|
}
|
|
|
|
/*
|
|
* test if LLC frame
|
|
*/
|
|
if (rfsw & RX_FS_LLC) {
|
|
/*
|
|
* if pass_llc_promisc is disable
|
|
* if DA != Multicast or Broadcast or DA!=MA
|
|
* abort the frame
|
|
*/
|
|
if (!smc->os.hwm.pass_llc_promisc) {
|
|
if(!(virt[1] & GROUP_ADDR_BIT)) {
|
|
if (virt[6] != MA[5] ||
|
|
virt[5] != MA[4] ||
|
|
virt[4] != MA[3] ||
|
|
virt[3] != MA[2] ||
|
|
virt[2] != MA[1] ||
|
|
virt[1] != MA[0]) {
|
|
DB_RX("DA != MA and not multi- or broadcast",0,0,2) ;
|
|
goto abort_frame ;
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* LLC frame received
|
|
*/
|
|
DB_RX("LLC - receive",0,0,4) ;
|
|
mac_drv_rx_complete(smc,rxd,frag_count,len) ;
|
|
}
|
|
else {
|
|
if (!(mb = smt_get_mbuf(smc))) {
|
|
smc->hw.fp.err_stats.err_no_buf++ ;
|
|
DB_RX("No SMbuf; receive terminated",0,0,4) ;
|
|
goto abort_frame ;
|
|
}
|
|
data = smtod(mb,char *) - 1 ;
|
|
|
|
/*
|
|
* copy the frame into a SMT_MBuf
|
|
*/
|
|
#ifdef USE_OS_CPY
|
|
hwm_cpy_rxd2mb(rxd,data,len) ;
|
|
#else
|
|
for (r=rxd, i=used_frags ; i ; r=r->rxd_next, i--){
|
|
n = AIX_REVERSE(r->rxd_rbctrl) & RD_LENGTH ;
|
|
DB_RX("cp SMT frame to mb: len = %d",n,0,6) ;
|
|
memcpy(data,r->rxd_virt,n) ;
|
|
data += n ;
|
|
}
|
|
data = smtod(mb,char *) - 1 ;
|
|
#endif
|
|
fc = *(char *)mb->sm_data = *data ;
|
|
mb->sm_len = len - 1 ; /* len - fc */
|
|
data++ ;
|
|
|
|
/*
|
|
* SMT frame received
|
|
*/
|
|
switch(fc) {
|
|
case FC_SMT_INFO :
|
|
smc->hw.fp.err_stats.err_smt_frame++ ;
|
|
DB_RX("SMT frame received ",0,0,5) ;
|
|
|
|
if (smc->os.hwm.pass_SMT) {
|
|
DB_RX("pass SMT frame ",0,0,5) ;
|
|
mac_drv_rx_complete(smc, rxd,
|
|
frag_count,len) ;
|
|
}
|
|
else {
|
|
DB_RX("requeue RxD",0,0,5) ;
|
|
mac_drv_requeue_rxd(smc,rxd,frag_count);
|
|
}
|
|
|
|
smt_received_pack(smc,mb,(int)(rfsw>>25)) ;
|
|
break ;
|
|
case FC_SMT_NSA :
|
|
smc->hw.fp.err_stats.err_smt_frame++ ;
|
|
DB_RX("SMT frame received ",0,0,5) ;
|
|
|
|
/* if pass_NSA set pass the NSA frame or */
|
|
/* pass_SMT set and the A-Indicator */
|
|
/* is not set, pass the NSA frame */
|
|
if (smc->os.hwm.pass_NSA ||
|
|
(smc->os.hwm.pass_SMT &&
|
|
!(rfsw & A_INDIC))) {
|
|
DB_RX("pass SMT frame ",0,0,5) ;
|
|
mac_drv_rx_complete(smc, rxd,
|
|
frag_count,len) ;
|
|
}
|
|
else {
|
|
DB_RX("requeue RxD",0,0,5) ;
|
|
mac_drv_requeue_rxd(smc,rxd,frag_count);
|
|
}
|
|
|
|
smt_received_pack(smc,mb,(int)(rfsw>>25)) ;
|
|
break ;
|
|
case FC_BEACON :
|
|
if (smc->os.hwm.pass_DB) {
|
|
DB_RX("pass DB frame ",0,0,5) ;
|
|
mac_drv_rx_complete(smc, rxd,
|
|
frag_count,len) ;
|
|
}
|
|
else {
|
|
DB_RX("requeue RxD",0,0,5) ;
|
|
mac_drv_requeue_rxd(smc,rxd,frag_count);
|
|
}
|
|
smt_free_mbuf(smc,mb) ;
|
|
break ;
|
|
default :
|
|
/*
|
|
* unknown FC abord the frame
|
|
*/
|
|
DB_RX("unknown FC error",0,0,2) ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
DB_RX("requeue RxD",0,0,5) ;
|
|
mac_drv_requeue_rxd(smc,rxd,frag_count) ;
|
|
if ((fc & 0xf0) == FC_MAC)
|
|
smc->hw.fp.err_stats.err_mac_frame++ ;
|
|
else
|
|
smc->hw.fp.err_stats.err_imp_frame++ ;
|
|
|
|
break ;
|
|
}
|
|
}
|
|
|
|
DB_RX("next RxD is %x ",queue->rx_curr_get,0,3) ;
|
|
NDD_TRACE("RHx1",queue->rx_curr_get,0,0) ;
|
|
|
|
continue ;
|
|
/*--------------------------------------------------------------------*/
|
|
abort_frame:
|
|
DB_RX("requeue RxD",0,0,5) ;
|
|
mac_drv_requeue_rxd(smc,rxd,frag_count) ;
|
|
|
|
DB_RX("next RxD is %x ",queue->rx_curr_get,0,3) ;
|
|
NDD_TRACE("RHx2",queue->rx_curr_get,0,0) ;
|
|
}
|
|
rx_end:
|
|
#ifdef ALL_RX_COMPLETE
|
|
mac_drv_all_receives_complete(smc) ;
|
|
#endif
|
|
return ; /* lint bug: needs return detect end of function */
|
|
}
|
|
|
|
static void smt_to_llc(struct s_smc *smc, SMbuf *mb)
|
|
{
|
|
u_char fc ;
|
|
|
|
DB_RX("send a queued frame to the llc layer",0,0,4) ;
|
|
smc->os.hwm.r.len = mb->sm_len ;
|
|
smc->os.hwm.r.mb_pos = smtod(mb,char *) ;
|
|
fc = *smc->os.hwm.r.mb_pos ;
|
|
(void)mac_drv_rx_init(smc,(int)mb->sm_len,(int)fc,
|
|
smc->os.hwm.r.mb_pos,(int)mb->sm_len) ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
}
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(hwm_rx_frag)
|
|
* void hwm_rx_frag(smc,virt,phys,len,frame_status)
|
|
*
|
|
* function MACRO (hardware module, hwmtm.h)
|
|
* This function calls dma_master for preparing the
|
|
* system hardware for the DMA transfer and initializes
|
|
* the current RxD with the length and the physical and
|
|
* virtual address of the fragment. Furthermore, it sets the
|
|
* STF and EOF bits depending on the frame status byte,
|
|
* switches the OWN flag of the RxD, so that it is owned by the
|
|
* adapter and issues an rx_start.
|
|
*
|
|
* para virt virtual pointer to the fragment
|
|
* len the length of the fragment
|
|
* frame_status status of the frame, see design description
|
|
*
|
|
* NOTE: It is possible to call this function with a fragment length
|
|
* of zero.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void hwm_rx_frag(struct s_smc *smc, char far *virt, u_long phys, int len,
|
|
int frame_status)
|
|
{
|
|
struct s_smt_fp_rxd volatile *r ;
|
|
u_int rbctrl ;
|
|
|
|
NDD_TRACE("RHfB",virt,len,frame_status) ;
|
|
DB_RX("hwm_rx_frag: len = %d, frame_status = %x\n",len,frame_status,2) ;
|
|
r = smc->hw.fp.rx_q[QUEUE_R1].rx_curr_put ;
|
|
r->rxd_virt = virt ;
|
|
r->rxd_rbadr = AIX_REVERSE(phys) ;
|
|
rbctrl = AIX_REVERSE( (((u_long)frame_status &
|
|
(FIRST_FRAG|LAST_FRAG))<<26) |
|
|
(((u_long) frame_status & FIRST_FRAG) << 21) |
|
|
BMU_OWN | BMU_CHECK | BMU_EN_IRQ_EOF | len) ;
|
|
r->rxd_rbctrl = rbctrl ;
|
|
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORDEV) ;
|
|
outpd(ADDR(B0_R1_CSR),CSR_START) ;
|
|
smc->hw.fp.rx_q[QUEUE_R1].rx_free-- ;
|
|
smc->hw.fp.rx_q[QUEUE_R1].rx_used++ ;
|
|
smc->hw.fp.rx_q[QUEUE_R1].rx_curr_put = r->rxd_next ;
|
|
NDD_TRACE("RHfE",r,AIX_REVERSE(r->rxd_rbadr),0) ;
|
|
}
|
|
|
|
/*
|
|
* BEGINN_MANUAL_ENTRY(mac_drv_clear_rx_queue)
|
|
*
|
|
* void mac_drv_clear_rx_queue(smc)
|
|
* struct s_smc *smc ;
|
|
*
|
|
* function DOWNCALL (hardware module, hwmtm.c)
|
|
* mac_drv_clear_rx_queue is called by the OS-specific module
|
|
* after it has issued a card_stop.
|
|
* In this case, the frames in the receive queue are obsolete and
|
|
* should be removed. For removing mac_drv_clear_rx_queue
|
|
* calls dma_master for each RxD and mac_drv_clear_rxd for each
|
|
* receive buffer.
|
|
*
|
|
* NOTE: calling sequence card_stop:
|
|
* CLI_FBI(), card_stop(),
|
|
* mac_drv_clear_tx_queue(), mac_drv_clear_rx_queue(),
|
|
*
|
|
* NOTE: The caller is responsible that the BMUs are idle
|
|
* when this function is called.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void mac_drv_clear_rx_queue(struct s_smc *smc)
|
|
{
|
|
struct s_smt_fp_rxd volatile *r ;
|
|
struct s_smt_fp_rxd volatile *next_rxd ;
|
|
struct s_smt_rx_queue *queue ;
|
|
int frag_count ;
|
|
int i ;
|
|
|
|
if (smc->hw.hw_state != STOPPED) {
|
|
SK_BREAK() ;
|
|
SMT_PANIC(smc,HWM_E0012,HWM_E0012_MSG) ;
|
|
return ;
|
|
}
|
|
|
|
queue = smc->hw.fp.rx[QUEUE_R1] ;
|
|
DB_RX("clear_rx_queue",0,0,5) ;
|
|
|
|
/*
|
|
* dma_complete and mac_drv_clear_rxd for all RxDs / receive buffers
|
|
*/
|
|
r = queue->rx_curr_get ;
|
|
while (queue->rx_used) {
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
DB_RX("switch OWN bit of RxD 0x%x ",r,0,5) ;
|
|
r->rxd_rbctrl &= AIX_REVERSE(~BMU_OWN) ;
|
|
frag_count = 1 ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORDEV) ;
|
|
r = r->rxd_next ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
while (r != queue->rx_curr_put &&
|
|
!(r->rxd_rbctrl & AIX_REVERSE(BMU_ST_BUF))) {
|
|
DB_RX("Check STF bit in %x",(void *)r,0,5) ;
|
|
r->rxd_rbctrl &= AIX_REVERSE(~BMU_OWN) ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORDEV) ;
|
|
r = r->rxd_next ;
|
|
DRV_BUF_FLUSH(r,DDI_DMA_SYNC_FORCPU) ;
|
|
frag_count++ ;
|
|
}
|
|
DB_RX("STF bit found",0,0,5) ;
|
|
next_rxd = r ;
|
|
|
|
for (r=queue->rx_curr_get,i=frag_count; i ; r=r->rxd_next,i--){
|
|
DB_RX("dma_complete for RxD %x",(void *)r,0,5) ;
|
|
dma_complete(smc,(union s_fp_descr volatile *)r,DMA_WR);
|
|
}
|
|
|
|
DB_RX("mac_drv_clear_rxd: RxD %x frag_count %d ",
|
|
(void *)queue->rx_curr_get,frag_count,5) ;
|
|
mac_drv_clear_rxd(smc,queue->rx_curr_get,frag_count) ;
|
|
|
|
queue->rx_curr_get = next_rxd ;
|
|
queue->rx_used -= frag_count ;
|
|
queue->rx_free += frag_count ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
SEND FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(hwm_tx_init)
|
|
* int hwm_tx_init(smc,fc,frag_count,frame_len,frame_status)
|
|
*
|
|
* function DOWN_CALL (hardware module, hwmtm.c)
|
|
* hwm_tx_init checks if the frame can be sent through the
|
|
* corresponding send queue.
|
|
*
|
|
* para fc the frame control. To determine through which
|
|
* send queue the frame should be transmitted.
|
|
* 0x50 - 0x57: asynchronous LLC frame
|
|
* 0xD0 - 0xD7: synchronous LLC frame
|
|
* 0x41, 0x4F: SMT frame to the network
|
|
* 0x42: SMT frame to the network and to the local SMT
|
|
* 0x43: SMT frame to the local SMT
|
|
* frag_count count of the fragments for this frame
|
|
* frame_len length of the frame
|
|
* frame_status status of the frame, the send queue bit is already
|
|
* specified
|
|
*
|
|
* return frame_status
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
int hwm_tx_init(struct s_smc *smc, u_char fc, int frag_count, int frame_len,
|
|
int frame_status)
|
|
{
|
|
NDD_TRACE("THiB",fc,frag_count,frame_len) ;
|
|
smc->os.hwm.tx_p = smc->hw.fp.tx[frame_status & QUEUE_A0] ;
|
|
smc->os.hwm.tx_descr = TX_DESCRIPTOR | (((u_long)(frame_len-1)&3)<<27) ;
|
|
smc->os.hwm.tx_len = frame_len ;
|
|
DB_TX("hwm_tx_init: fc = %x, len = %d",fc,frame_len,3) ;
|
|
if ((fc & ~(FC_SYNC_BIT|FC_LLC_PRIOR)) == FC_ASYNC_LLC) {
|
|
frame_status |= LAN_TX ;
|
|
}
|
|
else {
|
|
switch (fc) {
|
|
case FC_SMT_INFO :
|
|
case FC_SMT_NSA :
|
|
frame_status |= LAN_TX ;
|
|
break ;
|
|
case FC_SMT_LOC :
|
|
frame_status |= LOC_TX ;
|
|
break ;
|
|
case FC_SMT_LAN_LOC :
|
|
frame_status |= LAN_TX | LOC_TX ;
|
|
break ;
|
|
default :
|
|
SMT_PANIC(smc,HWM_E0010,HWM_E0010_MSG) ;
|
|
}
|
|
}
|
|
if (!smc->hw.mac_ring_is_up) {
|
|
frame_status &= ~LAN_TX ;
|
|
frame_status |= RING_DOWN ;
|
|
DB_TX("Ring is down: terminate LAN_TX",0,0,2) ;
|
|
}
|
|
if (frag_count > smc->os.hwm.tx_p->tx_free) {
|
|
#ifndef NDIS_OS2
|
|
mac_drv_clear_txd(smc) ;
|
|
if (frag_count > smc->os.hwm.tx_p->tx_free) {
|
|
DB_TX("Out of TxDs, terminate LAN_TX",0,0,2) ;
|
|
frame_status &= ~LAN_TX ;
|
|
frame_status |= OUT_OF_TXD ;
|
|
}
|
|
#else
|
|
DB_TX("Out of TxDs, terminate LAN_TX",0,0,2) ;
|
|
frame_status &= ~LAN_TX ;
|
|
frame_status |= OUT_OF_TXD ;
|
|
#endif
|
|
}
|
|
DB_TX("frame_status = %x",frame_status,0,3) ;
|
|
NDD_TRACE("THiE",frame_status,smc->os.hwm.tx_p->tx_free,0) ;
|
|
return(frame_status) ;
|
|
}
|
|
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(hwm_tx_frag)
|
|
* void hwm_tx_frag(smc,virt,phys,len,frame_status)
|
|
*
|
|
* function DOWNCALL (hardware module, hwmtm.c)
|
|
* If the frame should be sent to the LAN, this function calls
|
|
* dma_master, fills the current TxD with the virtual and the
|
|
* physical address, sets the STF and EOF bits dependent on
|
|
* the frame status, and requests the BMU to start the
|
|
* transmit.
|
|
* If the frame should be sent to the local SMT, an SMT_MBuf
|
|
* is allocated if the FIRST_FRAG bit is set in the frame_status.
|
|
* The fragment of the frame is copied into the SMT MBuf.
|
|
* The function smt_received_pack is called if the LAST_FRAG
|
|
* bit is set in the frame_status word.
|
|
*
|
|
* para virt virtual pointer to the fragment
|
|
* len the length of the fragment
|
|
* frame_status status of the frame, see design description
|
|
*
|
|
* return nothing returned, no parameter is modified
|
|
*
|
|
* NOTE: It is possible to invoke this macro with a fragment length
|
|
* of zero.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void hwm_tx_frag(struct s_smc *smc, char far *virt, u_long phys, int len,
|
|
int frame_status)
|
|
{
|
|
struct s_smt_fp_txd volatile *t ;
|
|
struct s_smt_tx_queue *queue ;
|
|
u_int tbctrl ;
|
|
|
|
queue = smc->os.hwm.tx_p ;
|
|
|
|
NDD_TRACE("THfB",virt,len,frame_status) ;
|
|
/* Bug fix: AF / May 31 1999 (#missing)
|
|
* snmpinfo problem reported by IBM is caused by invalid
|
|
* t-pointer (txd) if LAN_TX is not set but LOC_TX only.
|
|
* Set: t = queue->tx_curr_put here !
|
|
*/
|
|
t = queue->tx_curr_put ;
|
|
|
|
DB_TX("hwm_tx_frag: len = %d, frame_status = %x ",len,frame_status,2) ;
|
|
if (frame_status & LAN_TX) {
|
|
/* '*t' is already defined */
|
|
DB_TX("LAN_TX: TxD = %x, virt = %x ",t,virt,3) ;
|
|
t->txd_virt = virt ;
|
|
t->txd_txdscr = AIX_REVERSE(smc->os.hwm.tx_descr) ;
|
|
t->txd_tbadr = AIX_REVERSE(phys) ;
|
|
tbctrl = AIX_REVERSE((((u_long)frame_status &
|
|
(FIRST_FRAG|LAST_FRAG|EN_IRQ_EOF))<< 26) |
|
|
BMU_OWN|BMU_CHECK |len) ;
|
|
t->txd_tbctrl = tbctrl ;
|
|
|
|
#ifndef AIX
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
outpd(queue->tx_bmu_ctl,CSR_START) ;
|
|
#else /* ifndef AIX */
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
if (frame_status & QUEUE_A0) {
|
|
outpd(ADDR(B0_XA_CSR),CSR_START) ;
|
|
}
|
|
else {
|
|
outpd(ADDR(B0_XS_CSR),CSR_START) ;
|
|
}
|
|
#endif
|
|
queue->tx_free-- ;
|
|
queue->tx_used++ ;
|
|
queue->tx_curr_put = t->txd_next ;
|
|
if (frame_status & LAST_FRAG) {
|
|
smc->mib.m[MAC0].fddiMACTransmit_Ct++ ;
|
|
}
|
|
}
|
|
if (frame_status & LOC_TX) {
|
|
DB_TX("LOC_TX: ",0,0,3) ;
|
|
if (frame_status & FIRST_FRAG) {
|
|
if(!(smc->os.hwm.tx_mb = smt_get_mbuf(smc))) {
|
|
smc->hw.fp.err_stats.err_no_buf++ ;
|
|
DB_TX("No SMbuf; transmit terminated",0,0,4) ;
|
|
}
|
|
else {
|
|
smc->os.hwm.tx_data =
|
|
smtod(smc->os.hwm.tx_mb,char *) - 1 ;
|
|
#ifdef USE_OS_CPY
|
|
#ifdef PASS_1ST_TXD_2_TX_COMP
|
|
hwm_cpy_txd2mb(t,smc->os.hwm.tx_data,
|
|
smc->os.hwm.tx_len) ;
|
|
#endif
|
|
#endif
|
|
}
|
|
}
|
|
if (smc->os.hwm.tx_mb) {
|
|
#ifndef USE_OS_CPY
|
|
DB_TX("copy fragment into MBuf ",0,0,3) ;
|
|
memcpy(smc->os.hwm.tx_data,virt,len) ;
|
|
smc->os.hwm.tx_data += len ;
|
|
#endif
|
|
if (frame_status & LAST_FRAG) {
|
|
#ifdef USE_OS_CPY
|
|
#ifndef PASS_1ST_TXD_2_TX_COMP
|
|
/*
|
|
* hwm_cpy_txd2mb(txd,data,len) copies 'len'
|
|
* bytes from the virtual pointer in 'rxd'
|
|
* to 'data'. The virtual pointer of the
|
|
* os-specific tx-buffer should be written
|
|
* in the LAST txd.
|
|
*/
|
|
hwm_cpy_txd2mb(t,smc->os.hwm.tx_data,
|
|
smc->os.hwm.tx_len) ;
|
|
#endif /* nPASS_1ST_TXD_2_TX_COMP */
|
|
#endif /* USE_OS_CPY */
|
|
smc->os.hwm.tx_data =
|
|
smtod(smc->os.hwm.tx_mb,char *) - 1 ;
|
|
*(char *)smc->os.hwm.tx_mb->sm_data =
|
|
*smc->os.hwm.tx_data ;
|
|
smc->os.hwm.tx_data++ ;
|
|
smc->os.hwm.tx_mb->sm_len =
|
|
smc->os.hwm.tx_len - 1 ;
|
|
DB_TX("pass LLC frame to SMT ",0,0,3) ;
|
|
smt_received_pack(smc,smc->os.hwm.tx_mb,
|
|
RD_FS_LOCAL) ;
|
|
}
|
|
}
|
|
}
|
|
NDD_TRACE("THfE",t,queue->tx_free,0) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* queues a receive for later send
|
|
*/
|
|
static void queue_llc_rx(struct s_smc *smc, SMbuf *mb)
|
|
{
|
|
DB_GEN("queue_llc_rx: mb = %x",(void *)mb,0,4) ;
|
|
smc->os.hwm.queued_rx_frames++ ;
|
|
mb->sm_next = (SMbuf *)NULL ;
|
|
if (smc->os.hwm.llc_rx_pipe == 0) {
|
|
smc->os.hwm.llc_rx_pipe = mb ;
|
|
}
|
|
else {
|
|
smc->os.hwm.llc_rx_tail->sm_next = mb ;
|
|
}
|
|
smc->os.hwm.llc_rx_tail = mb ;
|
|
|
|
/*
|
|
* force an timer IRQ to receive the data
|
|
*/
|
|
if (!smc->os.hwm.isr_flag) {
|
|
smt_force_irq(smc) ;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* get a SMbuf from the llc_rx_queue
|
|
*/
|
|
static SMbuf *get_llc_rx(struct s_smc *smc)
|
|
{
|
|
SMbuf *mb ;
|
|
|
|
if ((mb = smc->os.hwm.llc_rx_pipe)) {
|
|
smc->os.hwm.queued_rx_frames-- ;
|
|
smc->os.hwm.llc_rx_pipe = mb->sm_next ;
|
|
}
|
|
DB_GEN("get_llc_rx: mb = 0x%x",(void *)mb,0,4) ;
|
|
return(mb) ;
|
|
}
|
|
|
|
/*
|
|
* queues a transmit SMT MBuf during the time were the MBuf is
|
|
* queued the TxD ring
|
|
*/
|
|
static void queue_txd_mb(struct s_smc *smc, SMbuf *mb)
|
|
{
|
|
DB_GEN("_rx: queue_txd_mb = %x",(void *)mb,0,4) ;
|
|
smc->os.hwm.queued_txd_mb++ ;
|
|
mb->sm_next = (SMbuf *)NULL ;
|
|
if (smc->os.hwm.txd_tx_pipe == 0) {
|
|
smc->os.hwm.txd_tx_pipe = mb ;
|
|
}
|
|
else {
|
|
smc->os.hwm.txd_tx_tail->sm_next = mb ;
|
|
}
|
|
smc->os.hwm.txd_tx_tail = mb ;
|
|
}
|
|
|
|
/*
|
|
* get a SMbuf from the txd_tx_queue
|
|
*/
|
|
static SMbuf *get_txd_mb(struct s_smc *smc)
|
|
{
|
|
SMbuf *mb ;
|
|
|
|
if ((mb = smc->os.hwm.txd_tx_pipe)) {
|
|
smc->os.hwm.queued_txd_mb-- ;
|
|
smc->os.hwm.txd_tx_pipe = mb->sm_next ;
|
|
}
|
|
DB_GEN("get_txd_mb: mb = 0x%x",(void *)mb,0,4) ;
|
|
return(mb) ;
|
|
}
|
|
|
|
/*
|
|
* SMT Send function
|
|
*/
|
|
void smt_send_mbuf(struct s_smc *smc, SMbuf *mb, int fc)
|
|
{
|
|
char far *data ;
|
|
int len ;
|
|
int n ;
|
|
int i ;
|
|
int frag_count ;
|
|
int frame_status ;
|
|
SK_LOC_DECL(char far,*virt[3]) ;
|
|
int frag_len[3] ;
|
|
struct s_smt_tx_queue *queue ;
|
|
struct s_smt_fp_txd volatile *t ;
|
|
u_long phys ;
|
|
u_int tbctrl ;
|
|
|
|
NDD_TRACE("THSB",mb,fc,0) ;
|
|
DB_TX("smt_send_mbuf: mb = 0x%x, fc = 0x%x",mb,fc,4) ;
|
|
|
|
mb->sm_off-- ; /* set to fc */
|
|
mb->sm_len++ ; /* + fc */
|
|
data = smtod(mb,char *) ;
|
|
*data = fc ;
|
|
if (fc == FC_SMT_LOC)
|
|
*data = FC_SMT_INFO ;
|
|
|
|
/*
|
|
* determine the frag count and the virt addresses of the frags
|
|
*/
|
|
frag_count = 0 ;
|
|
len = mb->sm_len ;
|
|
while (len) {
|
|
n = SMT_PAGESIZE - ((long)data & (SMT_PAGESIZE-1)) ;
|
|
if (n >= len) {
|
|
n = len ;
|
|
}
|
|
DB_TX("frag: virt/len = 0x%x/%d ",(void *)data,n,5) ;
|
|
virt[frag_count] = data ;
|
|
frag_len[frag_count] = n ;
|
|
frag_count++ ;
|
|
len -= n ;
|
|
data += n ;
|
|
}
|
|
|
|
/*
|
|
* determine the frame status
|
|
*/
|
|
queue = smc->hw.fp.tx[QUEUE_A0] ;
|
|
if (fc == FC_BEACON || fc == FC_SMT_LOC) {
|
|
frame_status = LOC_TX ;
|
|
}
|
|
else {
|
|
frame_status = LAN_TX ;
|
|
if ((smc->os.hwm.pass_NSA &&(fc == FC_SMT_NSA)) ||
|
|
(smc->os.hwm.pass_SMT &&(fc == FC_SMT_INFO)))
|
|
frame_status |= LOC_TX ;
|
|
}
|
|
|
|
if (!smc->hw.mac_ring_is_up || frag_count > queue->tx_free) {
|
|
frame_status &= ~LAN_TX;
|
|
if (frame_status) {
|
|
DB_TX("Ring is down: terminate LAN_TX",0,0,2) ;
|
|
}
|
|
else {
|
|
DB_TX("Ring is down: terminate transmission",0,0,2) ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
return ;
|
|
}
|
|
}
|
|
DB_TX("frame_status = 0x%x ",frame_status,0,5) ;
|
|
|
|
if ((frame_status & LAN_TX) && (frame_status & LOC_TX)) {
|
|
mb->sm_use_count = 2 ;
|
|
}
|
|
|
|
if (frame_status & LAN_TX) {
|
|
t = queue->tx_curr_put ;
|
|
frame_status |= FIRST_FRAG ;
|
|
for (i = 0; i < frag_count; i++) {
|
|
DB_TX("init TxD = 0x%x",(void *)t,0,5) ;
|
|
if (i == frag_count-1) {
|
|
frame_status |= LAST_FRAG ;
|
|
t->txd_txdscr = AIX_REVERSE(TX_DESCRIPTOR |
|
|
(((u_long)(mb->sm_len-1)&3) << 27)) ;
|
|
}
|
|
t->txd_virt = virt[i] ;
|
|
phys = dma_master(smc, (void far *)virt[i],
|
|
frag_len[i], DMA_RD|SMT_BUF) ;
|
|
t->txd_tbadr = AIX_REVERSE(phys) ;
|
|
tbctrl = AIX_REVERSE((((u_long) frame_status &
|
|
(FIRST_FRAG|LAST_FRAG)) << 26) |
|
|
BMU_OWN | BMU_CHECK | BMU_SMT_TX |frag_len[i]) ;
|
|
t->txd_tbctrl = tbctrl ;
|
|
#ifndef AIX
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
outpd(queue->tx_bmu_ctl,CSR_START) ;
|
|
#else
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
outpd(ADDR(B0_XA_CSR),CSR_START) ;
|
|
#endif
|
|
frame_status &= ~FIRST_FRAG ;
|
|
queue->tx_curr_put = t = t->txd_next ;
|
|
queue->tx_free-- ;
|
|
queue->tx_used++ ;
|
|
}
|
|
smc->mib.m[MAC0].fddiMACTransmit_Ct++ ;
|
|
queue_txd_mb(smc,mb) ;
|
|
}
|
|
|
|
if (frame_status & LOC_TX) {
|
|
DB_TX("pass Mbuf to LLC queue",0,0,5) ;
|
|
queue_llc_rx(smc,mb) ;
|
|
}
|
|
|
|
/*
|
|
* We need to unqueue the free SMT_MBUFs here, because it may
|
|
* be that the SMT want's to send more than 1 frame for one down call
|
|
*/
|
|
mac_drv_clear_txd(smc) ;
|
|
NDD_TRACE("THSE",t,queue->tx_free,frag_count) ;
|
|
}
|
|
|
|
/* BEGIN_MANUAL_ENTRY(mac_drv_clear_txd)
|
|
* void mac_drv_clear_txd(smc)
|
|
*
|
|
* function DOWNCALL (hardware module, hwmtm.c)
|
|
* mac_drv_clear_txd searches in both send queues for TxD's
|
|
* which were finished by the adapter. It calls dma_complete
|
|
* for each TxD. If the last fragment of an LLC frame is
|
|
* reached, it calls mac_drv_tx_complete to release the
|
|
* send buffer.
|
|
*
|
|
* return nothing
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
static void mac_drv_clear_txd(struct s_smc *smc)
|
|
{
|
|
struct s_smt_tx_queue *queue ;
|
|
struct s_smt_fp_txd volatile *t1 ;
|
|
struct s_smt_fp_txd volatile *t2 = NULL ;
|
|
SMbuf *mb ;
|
|
u_long tbctrl ;
|
|
int i ;
|
|
int frag_count ;
|
|
int n ;
|
|
|
|
NDD_TRACE("THcB",0,0,0) ;
|
|
for (i = QUEUE_S; i <= QUEUE_A0; i++) {
|
|
queue = smc->hw.fp.tx[i] ;
|
|
t1 = queue->tx_curr_get ;
|
|
DB_TX("clear_txd: QUEUE = %d (0=sync/1=async)",i,0,5) ;
|
|
|
|
for ( ; ; ) {
|
|
frag_count = 0 ;
|
|
|
|
do {
|
|
DRV_BUF_FLUSH(t1,DDI_DMA_SYNC_FORCPU) ;
|
|
DB_TX("check OWN/EOF bit of TxD 0x%x",t1,0,5) ;
|
|
tbctrl = CR_READ(t1->txd_tbctrl) ;
|
|
tbctrl = AIX_REVERSE(tbctrl) ;
|
|
|
|
if (tbctrl & BMU_OWN || !queue->tx_used){
|
|
DB_TX("End of TxDs queue %d",i,0,4) ;
|
|
goto free_next_queue ; /* next queue */
|
|
}
|
|
t1 = t1->txd_next ;
|
|
frag_count++ ;
|
|
} while (!(tbctrl & BMU_EOF)) ;
|
|
|
|
t1 = queue->tx_curr_get ;
|
|
for (n = frag_count; n; n--) {
|
|
tbctrl = AIX_REVERSE(t1->txd_tbctrl) ;
|
|
dma_complete(smc,
|
|
(union s_fp_descr volatile *) t1,
|
|
(int) (DMA_RD |
|
|
((tbctrl & BMU_SMT_TX) >> 18))) ;
|
|
t2 = t1 ;
|
|
t1 = t1->txd_next ;
|
|
}
|
|
|
|
if (tbctrl & BMU_SMT_TX) {
|
|
mb = get_txd_mb(smc) ;
|
|
smt_free_mbuf(smc,mb) ;
|
|
}
|
|
else {
|
|
#ifndef PASS_1ST_TXD_2_TX_COMP
|
|
DB_TX("mac_drv_tx_comp for TxD 0x%x",t2,0,4) ;
|
|
mac_drv_tx_complete(smc,t2) ;
|
|
#else
|
|
DB_TX("mac_drv_tx_comp for TxD 0x%x",
|
|
queue->tx_curr_get,0,4) ;
|
|
mac_drv_tx_complete(smc,queue->tx_curr_get) ;
|
|
#endif
|
|
}
|
|
queue->tx_curr_get = t1 ;
|
|
queue->tx_free += frag_count ;
|
|
queue->tx_used -= frag_count ;
|
|
}
|
|
free_next_queue: ;
|
|
}
|
|
NDD_TRACE("THcE",0,0,0) ;
|
|
}
|
|
|
|
/*
|
|
* BEGINN_MANUAL_ENTRY(mac_drv_clear_tx_queue)
|
|
*
|
|
* void mac_drv_clear_tx_queue(smc)
|
|
* struct s_smc *smc ;
|
|
*
|
|
* function DOWNCALL (hardware module, hwmtm.c)
|
|
* mac_drv_clear_tx_queue is called from the SMT when
|
|
* the RMT state machine has entered the ISOLATE state.
|
|
* This function is also called by the os-specific module
|
|
* after it has called the function card_stop().
|
|
* In this case, the frames in the send queues are obsolete and
|
|
* should be removed.
|
|
*
|
|
* note calling sequence:
|
|
* CLI_FBI(), card_stop(),
|
|
* mac_drv_clear_tx_queue(), mac_drv_clear_rx_queue(),
|
|
*
|
|
* NOTE: The caller is responsible that the BMUs are idle
|
|
* when this function is called.
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void mac_drv_clear_tx_queue(struct s_smc *smc)
|
|
{
|
|
struct s_smt_fp_txd volatile *t ;
|
|
struct s_smt_tx_queue *queue ;
|
|
int tx_used ;
|
|
int i ;
|
|
|
|
if (smc->hw.hw_state != STOPPED) {
|
|
SK_BREAK() ;
|
|
SMT_PANIC(smc,HWM_E0011,HWM_E0011_MSG) ;
|
|
return ;
|
|
}
|
|
|
|
for (i = QUEUE_S; i <= QUEUE_A0; i++) {
|
|
queue = smc->hw.fp.tx[i] ;
|
|
DB_TX("clear_tx_queue: QUEUE = %d (0=sync/1=async)",i,0,5) ;
|
|
|
|
/*
|
|
* switch the OWN bit of all pending frames to the host
|
|
*/
|
|
t = queue->tx_curr_get ;
|
|
tx_used = queue->tx_used ;
|
|
while (tx_used) {
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORCPU) ;
|
|
DB_TX("switch OWN bit of TxD 0x%x ",t,0,5) ;
|
|
t->txd_tbctrl &= AIX_REVERSE(~BMU_OWN) ;
|
|
DRV_BUF_FLUSH(t,DDI_DMA_SYNC_FORDEV) ;
|
|
t = t->txd_next ;
|
|
tx_used-- ;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* release all TxD's for both send queues
|
|
*/
|
|
mac_drv_clear_txd(smc) ;
|
|
|
|
for (i = QUEUE_S; i <= QUEUE_A0; i++) {
|
|
queue = smc->hw.fp.tx[i] ;
|
|
t = queue->tx_curr_get ;
|
|
|
|
/*
|
|
* write the phys pointer of the NEXT descriptor into the
|
|
* BMU's current address descriptor pointer and set
|
|
* tx_curr_get and tx_curr_put to this position
|
|
*/
|
|
if (i == QUEUE_S) {
|
|
outpd(ADDR(B5_XS_DA),AIX_REVERSE(t->txd_ntdadr)) ;
|
|
}
|
|
else {
|
|
outpd(ADDR(B5_XA_DA),AIX_REVERSE(t->txd_ntdadr)) ;
|
|
}
|
|
|
|
queue->tx_curr_put = queue->tx_curr_get->txd_next ;
|
|
queue->tx_curr_get = queue->tx_curr_put ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
-------------------------------------------------------------
|
|
TEST FUNCTIONS:
|
|
-------------------------------------------------------------
|
|
*/
|
|
|
|
#ifdef DEBUG
|
|
/*
|
|
* BEGIN_MANUAL_ENTRY(mac_drv_debug_lev)
|
|
* void mac_drv_debug_lev(smc,flag,lev)
|
|
*
|
|
* function DOWNCALL (drvsr.c)
|
|
* To get a special debug info the user can assign a debug level
|
|
* to any debug flag.
|
|
*
|
|
* para flag debug flag, possible values are:
|
|
* = 0: reset all debug flags (the defined level is
|
|
* ignored)
|
|
* = 1: debug.d_smtf
|
|
* = 2: debug.d_smt
|
|
* = 3: debug.d_ecm
|
|
* = 4: debug.d_rmt
|
|
* = 5: debug.d_cfm
|
|
* = 6: debug.d_pcm
|
|
*
|
|
* = 10: debug.d_os.hwm_rx (hardware module receive path)
|
|
* = 11: debug.d_os.hwm_tx(hardware module transmit path)
|
|
* = 12: debug.d_os.hwm_gen(hardware module general flag)
|
|
*
|
|
* lev debug level
|
|
*
|
|
* END_MANUAL_ENTRY
|
|
*/
|
|
void mac_drv_debug_lev(struct s_smc *smc, int flag, int lev)
|
|
{
|
|
switch(flag) {
|
|
case (int)NULL:
|
|
DB_P.d_smtf = DB_P.d_smt = DB_P.d_ecm = DB_P.d_rmt = 0 ;
|
|
DB_P.d_cfm = 0 ;
|
|
DB_P.d_os.hwm_rx = DB_P.d_os.hwm_tx = DB_P.d_os.hwm_gen = 0 ;
|
|
#ifdef SBA
|
|
DB_P.d_sba = 0 ;
|
|
#endif
|
|
#ifdef ESS
|
|
DB_P.d_ess = 0 ;
|
|
#endif
|
|
break ;
|
|
case DEBUG_SMTF:
|
|
DB_P.d_smtf = lev ;
|
|
break ;
|
|
case DEBUG_SMT:
|
|
DB_P.d_smt = lev ;
|
|
break ;
|
|
case DEBUG_ECM:
|
|
DB_P.d_ecm = lev ;
|
|
break ;
|
|
case DEBUG_RMT:
|
|
DB_P.d_rmt = lev ;
|
|
break ;
|
|
case DEBUG_CFM:
|
|
DB_P.d_cfm = lev ;
|
|
break ;
|
|
case DEBUG_PCM:
|
|
DB_P.d_pcm = lev ;
|
|
break ;
|
|
case DEBUG_SBA:
|
|
#ifdef SBA
|
|
DB_P.d_sba = lev ;
|
|
#endif
|
|
break ;
|
|
case DEBUG_ESS:
|
|
#ifdef ESS
|
|
DB_P.d_ess = lev ;
|
|
#endif
|
|
break ;
|
|
case DB_HWM_RX:
|
|
DB_P.d_os.hwm_rx = lev ;
|
|
break ;
|
|
case DB_HWM_TX:
|
|
DB_P.d_os.hwm_tx = lev ;
|
|
break ;
|
|
case DB_HWM_GEN:
|
|
DB_P.d_os.hwm_gen = lev ;
|
|
break ;
|
|
default:
|
|
break ;
|
|
}
|
|
}
|
|
#endif
|