From 4c93ccd7fbf311c1d223eefe8a6fb5dcec07f704 Mon Sep 17 00:00:00 2001 From: Ryan Thomas McBride Date: Sat, 26 Jun 2004 22:05:26 +0000 Subject: KNF --- sys/dev/pci/if_sandrv.c | 1152 ++++++++++++++++++++++------------------------- 1 file changed, 528 insertions(+), 624 deletions(-) (limited to 'sys/dev/pci/if_sandrv.c') diff --git a/sys/dev/pci/if_sandrv.c b/sys/dev/pci/if_sandrv.c index 8d1baede0a5..fda3c4e6e8e 100644 --- a/sys/dev/pci/if_sandrv.c +++ b/sys/dev/pci/if_sandrv.c @@ -1,4 +1,4 @@ -/* $OpenBSD: if_sandrv.c,v 1.2 2004/06/26 20:17:23 mcbride Exp $ */ +/* $OpenBSD: if_sandrv.c,v 1.3 2004/06/26 22:05:25 mcbride Exp $ */ /*- * Copyright (c) 2001-2004 Sangoma Technologies (SAN) @@ -35,56 +35,42 @@ #define __SDLA_HW_LEVEL #define __SDLADRV__ -/* -**************************************************************************** -**** For Debug purpose (only OpenBSD) **** -**************************************************************************** -*/ - -/*************************************************************************** -**** I N C L U D E F I L E S **** -***************************************************************************/ - -# include -# include -# include -# include -# include -# include +#include +#include +#include +#include +#include +#include -# include -# include -# include -# include - -/*************************************************************************** -**** M A C R O S / D E F I N E S **** -***************************************************************************/ +#include +#include +#include +#include #define EXEC_DELAY 20 /* shared memory access delay, mks */ -# define EXEC_TIMEOUT (hz*2) +#define EXEC_TIMEOUT (hz*2) #define MAX_NLOOPS (EXEC_DELAY*2000) - /* timeout used if jiffies are stopped + /* timeout used if jiffies are stopped ** EXEC_DELAY=20 - ** EXEC_TIMEOUT=EXEC_DELAY*2000 = 40000 + ** EXEC_TIMEOUT=EXEC_DELAY*2000 = 40000 ** 40000 ~= 80 jiffies = EXEC_TIMEOUT */ - -#define EXEC_HZ_DIVISOR 8/10 + +#define EXEC_HZ_DIVISOR 8/10 /* We don't want to wait a full second on sdla_exec - ** timeout, thus use HZ * EXEC_HZ_DIVISOR to get + ** timeout, thus use HZ * EXEC_HZ_DIVISOR to get ** the number of jiffies we would like to wait */ #define IS_SUPPORTED_ADAPTER(hw) ((hw)->type == SDLA_AFT) #define SDLA_CTYPE_NAME(type) \ ((type) == SDLA_AFT) ? "AFT" : "Unknown" - + #define IS_AFT(hw) (hw->type == SDLA_AFT) /* Definitions for identifying and finding S514 PCI adapters */ #define V3_VENDOR_ID 0x11B0 /* V3 vendor ID number */ -#define V3_DEVICE_ID 0x0002 /* V3 device ID number */ -#define SANGOMA_SUBSYS_VENDOR 0x4753 /* ID for Sangoma */ +#define V3_DEVICE_ID 0x0002 /* V3 device ID number */ +#define SANGOMA_SUBSYS_VENDOR 0x4753 /* ID for Sangoma */ /* Definition for identifying and finding XILINX PCI adapters */ #define SANGOMA_PCI_VENDOR 0x1923 /* Old value -> 0x11B0 */ @@ -97,7 +83,8 @@ /* Read PCI SUBVENDOR ID */ #define PCI_SUBVENDOR_MASK 0xFFFF -#define PCI_SUBVENDOR(pa) (pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG) & PCI_SUBVENDOR_MASK) +#define PCI_SUBVENDOR(pa) (pci_conf_read(pa->pa_pc, pa->pa_tag, \ + PCI_SUBSYS_ID_REG) & PCI_SUBVENDOR_MASK) #define PCI_DEVICE_MASK 0xFFFF0000 #define PCI_DEVICE(id) ((id & PCI_DEVICE_MASK ) >> 16) @@ -107,14 +94,13 @@ #define SDLA_IO_MAPPED 0x0004 #define SDLA_PCI_ENABLE 0x0008 -struct san_softc -{ +struct san_softc { struct device dev; - struct pci_attach_args pa; + struct pci_attach_args pa; }; typedef struct sdla_hw_probe { - int used; + int used; unsigned char hw_info[100]; LIST_ENTRY(sdla_hw_probe) next; } sdla_hw_probe_t; @@ -123,12 +109,12 @@ typedef struct sdla_hw_probe { * This structure keeps common parameters per physical card. */ typedef struct sdlahw_card { - int used; + int used; unsigned int type; /* S50x/S514/ADSL/XILINX */ unsigned int atype; /* SubVendor ID */ unsigned char core_id; /* SubSystem ID [0..7] */ unsigned char core_rev; /* SubSystem ID [8..15] */ - unsigned char pci_extra_ver; + unsigned char pci_extra_ver; unsigned int slot_no; unsigned int bus_no; bus_space_tag_t memt; @@ -137,75 +123,72 @@ typedef struct sdlahw_card { LIST_ENTRY(sdlahw_card) next; } sdlahw_card_t; -/*---------------------------------------------------------------------------- +/* * Adapter hardware configuration. Pointer to this structure is passed to all * APIs. */ -typedef struct sdlahw -{ - int used; - unsigned magic; - char devname[20]; - u_int16_t status; - int irq; /* interrupt request level */ - unsigned int cpu_no; /* PCI CPU Number */ - char auto_pci_cfg; /* Auto PCI configuration */ - bus_addr_t mem_base_addr; - bus_space_handle_t dpmbase; /* dual-port memory base */ - unsigned dpmsize; /* dual-port memory size */ - unsigned long memory; /* memory size */ - - unsigned reserved[5]; - unsigned char hw_info[100]; - - u_int16_t configured; - void *arg; /* card structure */ - sdla_hw_probe_t* hwprobe; - sdlahw_card_t* hwcard; - LIST_ENTRY(sdlahw) next; +typedef struct sdlahw { + int used; + unsigned magic; + char devname[20]; + u_int16_t status; + int irq; /* interrupt request level */ + unsigned int cpu_no; /* PCI CPU Number */ + char auto_pci_cfg; /* Auto PCI configuration */ + bus_addr_t mem_base_addr; + bus_space_handle_t dpmbase; /* dual-port memory base */ + unsigned dpmsize; /* dual-port memory size */ + unsigned long memory; /* memory size */ + + unsigned reserved[5]; + unsigned char hw_info[100]; + + u_int16_t configured; + void *arg; /* card structure */ + sdla_hw_probe_t *hwprobe; + sdlahw_card_t *hwcard; + LIST_ENTRY(sdlahw) next; } sdlahw_t; -/****** Function Prototypes *************************************************/ /* Entry Point for Low-Level function */ int sdladrv_init(void); int sdladrv_exit(void); -static int sdla_pci_probe(int, struct pci_attach_args*); +static int sdla_pci_probe(int, struct pci_attach_args *); /* PCI bus interface function */ -static int sdla_pci_write_config_word(void*, int, u_int16_t); -static int sdla_pci_write_config_dword(void*, int, u_int32_t); -static int sdla_pci_read_config_byte(void*, int, u_int8_t*); -static int sdla_pci_read_config_word(void*, int, u_int16_t*); -static int sdla_pci_read_config_dword(void*, int, u_int32_t*); - -static int sdla_detect (sdlahw_t* hw); -static int sdla_detect_aft(sdlahw_t* hw); -static int sdla_exec (sdlahw_t* hw, unsigned long offset); -static void sdla_peek_by_4 (sdlahw_t*, unsigned long, void*, unsigned int); -static void sdla_poke_by_4 (sdlahw_t*, unsigned long, void*, unsigned int); - -static sdlahw_card_t* sdla_card_register(u_int16_t atype, int slot_no, int bus_no); +static int sdla_pci_write_config_word(void *, int, u_int16_t); +static int sdla_pci_write_config_dword(void *, int, u_int32_t); +static int sdla_pci_read_config_byte(void *, int, u_int8_t *); +static int sdla_pci_read_config_word(void *, int, u_int16_t *); +static int sdla_pci_read_config_dword(void *, int, u_int32_t *); + +static int sdla_detect (sdlahw_t *); +static int sdla_detect_aft(sdlahw_t *); +static int sdla_exec(sdlahw_t *, unsigned long); +static void sdla_peek_by_4(sdlahw_t *, unsigned long, void *, unsigned int); +static void sdla_poke_by_4(sdlahw_t *, unsigned long, void *, unsigned int); + +static sdlahw_card_t* sdla_card_register(u_int16_t, int, int); #if 0 static int sdla_card_unregister (unsigned char hw_type, int slot_no, int bus_no, int ioport); #endif -static sdlahw_card_t* sdla_card_search(u_int16_t atype, int slot_no, int bus_no); +static sdlahw_card_t* sdla_card_search(u_int16_t, int, int); -static sdlahw_t* sdla_hw_register(sdlahw_card_t* card, int cpu_no, int irq, void*); +static sdlahw_t* sdla_hw_register(sdlahw_card_t *, int, int, void *); #if 0 static int sdla_hw_unregister(sdlahw_card_t* card, int cpu_no); #endif -static sdlahw_t* sdla_hw_search(u_int16_t atype, int slot_no, int bus_no, int cpu_no); - -static sdlahw_t* sdla_aft_hw_select (sdlahw_card_t* card, int cpu_no, int irq, struct pci_attach_args* pa); -static void sdla_save_hw_probe (sdlahw_t* hw, int port); +static sdlahw_t* sdla_hw_search(u_int16_t, int, int, int); +static sdlahw_t* sdla_aft_hw_select (sdlahw_card_t *, int, int, + struct pci_attach_args *); +static void sdla_save_hw_probe (sdlahw_t*, int); -/* SDLA PCI device relative entry point */ -int san_match __P((struct device*, void*, void*)); -void san_attach __P((struct device*, struct device*, void*)); +/* SDLA PCI device relative entry point */ +int san_match __P((struct device *, void *, void *)); +void san_attach __P((struct device *, struct device *, void *)); -/****** Global Data *********************************************************/ struct cfdriver san_cd = { NULL, "san", DV_IFNET @@ -223,53 +206,55 @@ static int Sangoma_devices_no = 0; static int Sangoma_PCI_cards_no = 0; /* private data */ -char *san_drvname = "san"; +char *san_drvname = "san"; /* Array of already initialized PCI slots */ static int pci_slot_ar[MAX_S514_CARDS]; -LIST_HEAD(, sdlahw_card) sdlahw_card_head = - LIST_HEAD_INITIALIZER(sdlahw_card_head); -LIST_HEAD(, sdlahw) sdlahw_head = - LIST_HEAD_INITIALIZER(sdlahw_head); -LIST_HEAD(, sdla_hw_probe) sdlahw_probe_head = - LIST_HEAD_INITIALIZER(sdlahw_probe_head); +LIST_HEAD(, sdlahw_card) sdlahw_card_head = + LIST_HEAD_INITIALIZER(sdlahw_card_head); +LIST_HEAD(, sdlahw) sdlahw_head = + LIST_HEAD_INITIALIZER(sdlahw_head); +LIST_HEAD(, sdla_hw_probe) sdlahw_probe_head = + LIST_HEAD_INITIALIZER(sdlahw_probe_head); static sdla_hw_type_cnt_t sdla_adapter_cnt; -/***************************************************************************/ -/******* PCI Device Driver Entry Points ********************************/ -int san_match(parent, match, aux) - struct device* parent; - void* match, *aux; +/* + * PCI Device Driver Entry Points + */ +int +san_match(struct device *parent, void *match, void *aux) { struct pci_attach_args* pa = aux; - u_int16_t vendor_id = PCI_VENDOR(pa->pa_id); - u_int16_t device_id = PCI_DEVICE(pa->pa_id); - - if (!(vendor_id == SANGOMA_PCI_VENDOR && device_id == SANGOMA_PCI_DEVICE) || - (vendor_id == SANGOMA_PCI_VENDOR_OLD && device_id == SANGOMA_PCI_DEVICE)){ - return 0; + u_int16_t vendor_id = PCI_VENDOR(pa->pa_id); + u_int16_t device_id = PCI_DEVICE(pa->pa_id); + + if (!(vendor_id == SANGOMA_PCI_VENDOR && + device_id == SANGOMA_PCI_DEVICE) || + (vendor_id == SANGOMA_PCI_VENDOR_OLD && + device_id == SANGOMA_PCI_DEVICE)) { + return (0); } - return 1; + return (1); } #define PCI_CBIO 0x10 -void san_attach(parent, self, aux) - struct device *parent, *self; - void* aux; +void +san_attach(struct device *parent, struct device *self, void *aux) { struct pci_attach_args* pa = aux; - u_int16_t vendor_id = PCI_VENDOR(pa->pa_id); - u_int16_t subvendor_id = PCI_SUBVENDOR(pa); - int atype = 0x00; + u_int16_t vendor_id = PCI_VENDOR(pa->pa_id); + u_int16_t subvendor_id = PCI_SUBVENDOR(pa); + int atype = 0x00; - atype = PCI_PRODUCT(pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG)); - switch(vendor_id){ + atype = PCI_PRODUCT(pci_conf_read(pa->pa_pc, pa->pa_tag, + PCI_SUBSYS_ID_REG)); + switch (vendor_id) { case SANGOMA_PCI_VENDOR_OLD: case SANGOMA_PCI_VENDOR: - switch(subvendor_id){ + switch (subvendor_id) { case A101_1TE1_SUBSYS_VENDOR: atype = A101_ADPTR_1TE1; break; @@ -284,87 +269,89 @@ void san_attach(parent, self, aux) return; } - if (sdla_pci_probe(atype, pa)){ + if (sdla_pci_probe(atype, pa)) { printf(": PCI probe FAILED!\n"); return; } -#if defined(DEBUG) - switch(PCI_VENDOR(pa->pa_id)){ +#ifdef DEBUG + switch (PCI_VENDOR(pa->pa_id)) { case V3_VENDOR_ID: - switch(atype){ + switch (atype) { case S5141_ADPTR_1_CPU_SERIAL: - log(LOG_INFO, "%s: Sangoma S5141/FT1 (Single CPU) adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma S5141/FT1 (Single CPU) " + "adapter\n", self->dv_xname); break; case S5142_ADPTR_2_CPU_SERIAL: - log(LOG_INFO, "%s: Sangoma S5142 (Dual CPU) adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma S5142 (Dual CPU) adapter\n", + self->dv_xname); break; case S5143_ADPTR_1_CPU_FT1: - log(LOG_INFO, "%s: Sangoma S5143 (Single CPU) FT1 adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma S5143 (Single CPU) " + "FT1 adapter\n", self->dv_xname); break; case S5144_ADPTR_1_CPU_T1E1: case S5148_ADPTR_1_CPU_T1E1: - log(LOG_INFO, "%s: Sangoma S5144 (Single CPU) T1/E1 adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma S5144 (Single CPU) " + "T1/E1 adapter\n", self->dv_xname); break; - case S5145_ADPTR_1_CPU_56K: - log(LOG_INFO, "%s: Sangoma S5145 (Single CPU) 56K adapter\n", - self->dv_xname); + case S5145_ADPTR_1_CPU_56K: + log(LOG_INFO, "%s: Sangoma S5145 (Single CPU) " + "56K adapter\n", self->dv_xname); break; case S5147_ADPTR_2_CPU_T1E1: - log(LOG_INFO, "%s: Sangoma S5147 (Dual CPU) T1/E1 adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma S5147 (Dual CPU) " + "T1/E1 adapter\n", self->dv_xname); break; } break; case PCI_VENDOR_ID_GSI: - log(LOG_INFO, "%s: Sangoma S518 ADSL adapter\n", + log(LOG_INFO, "%s: Sangoma S518 ADSL adapter\n", self->dv_xname); break; case SANGOMA_PCI_VENDOR_OLD: - switch(atype){ + switch (atype) { case A101_ADPTR_1TE1: - log(LOG_INFO, "%s: Sangoma AFT (1 channel) T1/E1 adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma AFT (1 channel) " + "T1/E1 adapter\n", self->dv_xname); break; case A101_ADPTR_2TE1: - log(LOG_INFO, "%s: Sangoma AFT (2 channels) T1/E1 adapter\n", - self->dv_xname); + log(LOG_INFO, "%s: Sangoma AFT (2 channels) " + "T1/E1 adapter\n", self->dv_xname); break; } break; - } + } #endif return; } -/*========================================================================== +/* * Module init point. */ -int sdladrv_init(void) +int +sdladrv_init(void) { - int volatile i=0; + int volatile i = 0; /* Initialize the PCI Card array, which - * will store flags, used to mark - * card initialization state */ + * will store flags, used to mark + * card initialization state */ for (i=0; ihwcard, tmp->cpu_no) == -EBUSY){ @@ -383,12 +370,12 @@ int sdladrv_exit (void) LIST_INIT(&sdlahw_head); elm_hw_card = LIST_FIRST(&sdlahw_card_head); - while(elm_hw_card){ + while (elm_hw_card) { sdlahw_card_t *tmp = elm_hw_card; elm_hw_card = LIST_NEXT(elm_hw_card, next); - if (sdla_card_unregister(tmp->hw_type, - tmp->slot_no, - tmp->bus_no, + if (sdla_card_unregister(tmp->hw_type, + tmp->slot_no, + tmp->bus_no, tmp->ioport) == -EBUSY){ return -EBUSY; } @@ -396,7 +383,7 @@ int sdladrv_exit (void) LIST_INIT(&sdlahw_card_head); elm_hw_probe = LIST_FIRST(&sdlahw_probe_head); - while(elm_hw_probe){ + while (elm_hw_probe) { sdla_hw_probe_t *tmp = elm_hw_probe; elm_hw_probe = LIST_NEXT(elm_hw_probe, next); if (tmp->used){ @@ -408,23 +395,11 @@ int sdladrv_exit (void) free(tmp, M_DEVBUF); } #endif - return 0; + return (0); } -/* -***************************************************************************** -***************************************************************************** -G*** S A N G O M A H A R D W A R E P R O B E ***** -***************************************************************************** -***************************************************************************** -*/ -/* -***************************************************************************** -** sdla_save_hw_probe -***************************************************************************** -*/ -static void -sdla_save_hw_probe (sdlahw_t* hw, int port) +static void +sdla_save_hw_probe(sdlahw_t *hw, int port) { sdla_hw_probe_t *tmp_hw_probe; @@ -433,92 +408,75 @@ sdla_save_hw_probe (sdlahw_t* hw, int port) return; memset(tmp_hw_probe,0,sizeof(sdla_hw_probe_t)); - - /*sprintf(tmp_hw_probe->hw_info,*/ + snprintf(tmp_hw_probe->hw_info, sizeof(tmp_hw_probe->hw_info), - "%s : SLOT=%d : BUS=%d : IRQ=%d : CPU=%c : PORT=%s", - SDLA_ADPTR_DECODE(hw->hwcard->atype), - hw->hwcard->slot_no, - hw->hwcard->bus_no, - hw->irq, - SDLA_GET_CPU(hw->cpu_no), - "PRI"); + "%s : SLOT=%d : BUS=%d : IRQ=%d : CPU=%c : PORT=%s", + SDLA_ADPTR_DECODE(hw->hwcard->atype), hw->hwcard->slot_no, + hw->hwcard->bus_no, hw->irq, SDLA_GET_CPU(hw->cpu_no), "PRI"); hw->hwprobe = tmp_hw_probe; tmp_hw_probe->used++; LIST_INSERT_HEAD(&sdlahw_probe_head, tmp_hw_probe, next); } - -/* -***************************************************************************** -** sdla_hw_select -***************************************************************************** -*/ -static sdlahw_t* sdla_aft_hw_select (sdlahw_card_t* hwcard, int cpu_no, int irq, struct pci_attach_args* pa) +static sdlahw_t* +sdla_aft_hw_select(sdlahw_card_t *hwcard, int cpu_no, + int irq, struct pci_attach_args *pa) { - sdlahw_t* hw=NULL; + sdlahw_t* hw = NULL; int number_of_cards = 0; - + hwcard->type = SDLA_AFT; - switch(hwcard->atype){ + switch (hwcard->atype) { case A101_ADPTR_1TE1: hw = sdla_hw_register(hwcard, cpu_no, irq, pa); sdla_save_hw_probe(hw, 0); number_of_cards += 1; -#if defined(DEBUG) - log(LOG_INFO, "%s: %s T1/E1 card found (%s rev.%d), cpu(s) 1, bus #%d, slot #%d, irq #%d\n", - san_drvname, - SDLA_ADPTR_DECODE(hwcard->atype), - AFT_CORE_ID_DECODE(hwcard->core_id), - hwcard->core_rev, - hwcard->bus_no, hwcard->slot_no, irq); -#endif +#ifdef DEBUG + log(LOG_INFO, "%s: %s T1/E1 card found (%s rev.%d), " + "cpu(s) 1, bus #%d, slot #%d, irq #%d\n", san_drvname, + SDLA_ADPTR_DECODE(hwcard->atype), + AFT_CORE_ID_DECODE(hwcard->core_id), hwcard->core_rev, + hwcard->bus_no, hwcard->slot_no, irq); +#endif /* DEBUG */ break; - case A101_ADPTR_2TE1: hw = sdla_hw_register(hwcard, cpu_no, irq, pa); sdla_save_hw_probe(hw, 0); number_of_cards += 1; -#if defined(DEBUG) - log(LOG_INFO, "%s: %s T1/E1 card found (%s rev.%d), cpu(s) 2, bus #%d, slot #%d, irq #%d\n", - san_drvname, - SDLA_ADPTR_DECODE(hwcard->atype), - AFT_CORE_ID_DECODE(hwcard->core_id), - hwcard->core_rev, - hwcard->bus_no, hwcard->slot_no, irq); -#endif +#ifdef DEBUG + log(LOG_INFO, "%s: %s T1/E1 card found (%s rev.%d), " + "cpu(s) 2, bus #%d, slot #%d, irq #%d\n", san_drvname, + SDLA_ADPTR_DECODE(hwcard->atype), + AFT_CORE_ID_DECODE(hwcard->core_id), hwcard->core_rev, + hwcard->bus_no, hwcard->slot_no, irq); +#endif /* DEBUG */ break; - case A105_ADPTR_1_CHN_T3E3: hw = sdla_hw_register(hwcard, cpu_no, irq, pa); sdla_save_hw_probe(hw, 0); number_of_cards += 1; -#if defined(DEBUG) - log(LOG_INFO, "%s: %s T3/E3 card found, cpu(s) 1, bus #%d, slot #%d, irq #%d\n", - san_drvname, - SDLA_ADPTR_DECODE(hwcard->atype), - hwcard->bus_no, - hwcard->slot_no, - irq); -#endif +#ifdef DEBUG + log(LOG_INFO, "%s: %s T3/E3 card found, cpu(s) 1," + "bus #%d, slot #%d, irq #%d\n", san_drvname, + SDLA_ADPTR_DECODE(hwcard->atype), + hwcard->bus_no, hwcard->slot_no, irq); +#endif /* DEBUG */ break; - - default: - log(LOG_INFO, - "%s: Unknown adapter %04X (bus #%d, slot #%d, irq #%d)!\n", - san_drvname, hwcard->atype, hwcard->bus_no, hwcard->slot_no, irq); - - break; + log(LOG_INFO, "%s: Unknown adapter %04X " + "(bus #%d, slot #%d, irq #%d)!\n", san_drvname, + hwcard->atype, hwcard->bus_no, hwcard->slot_no, irq); + break; } - return hw; + return (hw); } -static int sdla_pci_probe(int atype, struct pci_attach_args* pa) +static int +sdla_pci_probe(int atype, struct pci_attach_args *pa) { sdlahw_card_t* hwcard; sdlahw_t* hw; @@ -538,27 +496,27 @@ static int sdla_pci_probe(int atype, struct pci_attach_args* pa) irq = (u_int8_t)pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_INTLINE); /* Map and establish the interrupt */ - if (pci_intr_map(pa,&ih)){ + if (pci_intr_map(pa,&ih)) { printf(": couldn't map interrupt\n"); - return -EINVAL; + return (-EINVAL); } intrstr = pci_intr_string(pa->pa_pc, ih); - if (intrstr != NULL){ + if (intrstr != NULL) { printf(" %s\n", intrstr); } Sangoma_cards_no ++; reg_new_card: Sangoma_PCI_cards_no ++; hwcard = sdla_card_register(atype, slot, bus); - if (hwcard == NULL){ - return -EINVAL; + if (hwcard == NULL) { + return (-EINVAL); } hwcard->memt = pa->pa_memt; hwcard->ih = ih; hwcard->pa = *pa; /* Increment number of available Sangoma devices */ Sangoma_devices_no ++; - switch(atype){ + switch (atype) { case A101_ADPTR_1TE1: case A101_ADPTR_2TE1: hw = sdla_aft_hw_select(hwcard, cpu, irq, pa); @@ -568,117 +526,97 @@ reg_new_card: } - if (hw == NULL) return -EINVAL; - if (san_dev_attach(hw, hw->devname)){ - return -EINVAL; + if (hw == NULL) + return (-EINVAL); + if (san_dev_attach(hw, hw->devname)) { + return (-EINVAL); } hw->used++; - if (dual_cpu && cpu == SDLA_CPU_A){ + if (dual_cpu && cpu == SDLA_CPU_A) { cpu = SDLA_CPU_B; goto reg_new_card; } - - return 0; + + return (0); } -int sdla_intr_establish(void *phw, int(*intr_func)(void*), void* intr_arg) +int +sdla_intr_establish(void *phw, int(*intr_func)(void*), void* intr_arg) { sdlahw_t *hw = (sdlahw_t*)phw; sdlahw_card_t *hwcard; WAN_ASSERT(hw == NULL); hwcard = hw->hwcard; - if (pci_intr_establish( - hwcard->pa.pa_pc, - hwcard->ih, - IPL_NET, - intr_func, - intr_arg, - "san") == NULL){ - return -EINVAL; + if (pci_intr_establish(hwcard->pa.pa_pc, hwcard->ih, IPL_NET, + intr_func, intr_arg, "san") == NULL) { + return (-EINVAL); } return 0; } - -int sdla_intr_disestablish(void *phw) + +int +sdla_intr_disestablish(void *phw) { sdlahw_t *hw = (sdlahw_t*)phw; log(LOG_INFO, "%d: Disestablish interrupt is not defined!\n", - hw->devname); - return -EINVAL; + hw->devname); + return (-EINVAL); } -/* -***************************************************************************** -** sdla_get_hw_devices -***************************************************************************** -*/ -int sdla_get_hw_devices (void) +int +sdla_get_hw_devices(void) { - return Sangoma_devices_no; + return (Sangoma_devices_no); } -/* -***************************************************************************** -** sdla_get_hw_adptr_cnt -***************************************************************************** -*/ -void *sdla_get_hw_adptr_cnt (void) +void +*sdla_get_hw_adptr_cnt(void) { - return &sdla_adapter_cnt; -} + return (&sdla_adapter_cnt); +} -/* -***************************************************************************** -** sdla_card_register -***************************************************************************** -*/ -static sdlahw_card_t* +static sdlahw_card_t* sdla_card_register(u_int16_t atype, int slot_no, int bus_no) { sdlahw_card_t *new_hwcard, *last_hwcard; new_hwcard = sdla_card_search(atype, slot_no, bus_no); - if (new_hwcard){ - return new_hwcard; + if (new_hwcard) { + return (new_hwcard); } new_hwcard = malloc(sizeof(sdlahw_card_t), M_DEVBUF, M_NOWAIT); - if (!new_hwcard){ - return NULL; + if (!new_hwcard) { + return (NULL); } memset(new_hwcard,0,sizeof(sdlahw_card_t)); - + new_hwcard->atype = atype; new_hwcard->slot_no = slot_no; - new_hwcard->bus_no = bus_no; + new_hwcard->bus_no = bus_no; - if (LIST_EMPTY(&sdlahw_card_head)){ + if (LIST_EMPTY(&sdlahw_card_head)) { /* Initialize SAN HW parameters */ sdladrv_init(); } - LIST_FOREACH(last_hwcard, &sdlahw_card_head, next){ - if (!LIST_NEXT(last_hwcard, next)){ + LIST_FOREACH(last_hwcard, &sdlahw_card_head, next) { + if (!LIST_NEXT(last_hwcard, next)) { break; } } - if (last_hwcard){ - LIST_INSERT_AFTER(last_hwcard, new_hwcard, next); - }else{ - LIST_INSERT_HEAD(&sdlahw_card_head, new_hwcard, next); + if (last_hwcard) { + LIST_INSERT_AFTER(last_hwcard, new_hwcard, next); + } else { + LIST_INSERT_HEAD(&sdlahw_card_head, new_hwcard, next); } - return new_hwcard; + return (new_hwcard); } -/* -***************************************************************************** -** sdla_card_unregister -***************************************************************************** -*/ #if 0 -static int +static int sdla_card_unregister (u_int16_t atype, int slot_no, int bus_no, int ioport) { sdlahw_card_t* tmp_card; @@ -687,7 +625,7 @@ sdla_card_unregister (u_int16_t atype, int slot_no, int bus_no, int ioport) if (tmp_card->atype != atype){ continue; } - if (tmp_card->slot_no == slot_no && + if (tmp_card->slot_no == slot_no && tmp_card->bus_no == bus_no){ break; } @@ -707,48 +645,40 @@ sdla_card_unregister (u_int16_t atype, int slot_no, int bus_no, int ioport) return 0; } #endif -/* -***************************************************************************** -** sdla_card_search -***************************************************************************** -*/ + static sdlahw_card_t* sdla_card_search(u_int16_t atype, int slot_no, int bus_no) { sdlahw_card_t* tmp_card; - - LIST_FOREACH(tmp_card, &sdlahw_card_head, next){ - if (tmp_card->atype != atype){ + + LIST_FOREACH(tmp_card, &sdlahw_card_head, next) { + if (tmp_card->atype != atype) { continue; } - if (tmp_card->slot_no == slot_no && - tmp_card->bus_no == bus_no){ - return tmp_card; + if (tmp_card->slot_no == slot_no && + tmp_card->bus_no == bus_no) { + return (tmp_card); } } - return NULL; + return (NULL); } -/* -***************************************************************************** -** sdla_cpu_register -***************************************************************************** -*/ -static sdlahw_t* -sdla_hw_register(sdlahw_card_t* card, int cpu_no, int irq, void* dev) +static sdlahw_t* +sdla_hw_register(sdlahw_card_t *card, int cpu_no, int irq, void *dev) { sdlahw_t *new_hw, *last_hw; - new_hw = sdla_hw_search(card->atype, card->slot_no, card->bus_no, cpu_no); - if (new_hw){ - return new_hw; + new_hw = sdla_hw_search(card->atype, card->slot_no, + card->bus_no, cpu_no); + if (new_hw) { + return (new_hw); } new_hw = malloc(sizeof(sdlahw_t), M_DEVBUF, M_NOWAIT); if (!new_hw) - return NULL; + return (NULL); memset(new_hw,0,sizeof(sdlahw_t)); - + new_hw->cpu_no = cpu_no; new_hw->irq = irq; new_hw->hwcard = card; @@ -758,30 +688,25 @@ sdla_hw_register(sdlahw_card_t* card, int cpu_no, int irq, void* dev) new_hw->magic = SDLAHW_MAGIC; card->used++; - LIST_FOREACH(last_hw, &sdlahw_head, next){ - if (!LIST_NEXT(last_hw, next)){ + LIST_FOREACH(last_hw, &sdlahw_head, next) { + if (!LIST_NEXT(last_hw, next)) { break; } } - if (last_hw){ - LIST_INSERT_AFTER(last_hw, new_hw, next); + if (last_hw) { + LIST_INSERT_AFTER(last_hw, new_hw, next); }else{ - LIST_INSERT_HEAD(&sdlahw_head, new_hw, next); + LIST_INSERT_HEAD(&sdlahw_head, new_hw, next); } - return new_hw; + return (new_hw); } -/* -***************************************************************************** -** sdla_hw_unregister -***************************************************************************** -*/ #if 0 -static int +static int sdla_hw_unregister (sdlahw_card_t* hwcard, int cpu_no) { sdlahw_t* tmp_hw; - int i; + int i; LIST_FOREACH(tmp_hw, &sdlahw_head, next){ if (tmp_hw->hwcard != hwcard){ @@ -805,60 +730,47 @@ sdla_hw_unregister (sdlahw_card_t* hwcard, int cpu_no) tmp_hw->hwprobe = NULL; tmp_hw->hwcard = NULL; hwcard->used--; /* Decrement card usage */ - LIST_REMOVE(tmp_hw, next); + LIST_REMOVE(tmp_hw, next); free(tmp_hw, M_DEVBUF); return 0; } #endif -/* -***************************************************************************** -** sdla_cpu_search -***************************************************************************** -*/ + static sdlahw_t* sdla_hw_search(u_int16_t atype, int slot_no, int bus_no, int cpu_no) { sdlahw_t* tmp_hw; - - LIST_FOREACH(tmp_hw, &sdlahw_head, next){ - if (tmp_hw->hwcard == NULL){ + + LIST_FOREACH(tmp_hw, &sdlahw_head, next) { + if (tmp_hw->hwcard == NULL) { log(LOG_INFO, "Critical Error: sdla_cpu_search: line %d\n", __LINE__); LIST_REMOVE(tmp_hw, next); continue; } - if (tmp_hw->hwcard->atype != atype){ + if (tmp_hw->hwcard->atype != atype) { LIST_REMOVE(tmp_hw, next); continue; } - if (tmp_hw->hwcard->slot_no == slot_no && - tmp_hw->hwcard->bus_no == bus_no && - tmp_hw->cpu_no == cpu_no){ - return tmp_hw; + if (tmp_hw->hwcard->slot_no == slot_no && + tmp_hw->hwcard->bus_no == bus_no && + tmp_hw->cpu_no == cpu_no) { + return (tmp_hw); } } - return NULL; + return (NULL); } /* -***************************************************************************** -***************************************************************************** -*** S A N G O M A H A R D W A R E R E G I S T E R ***** -***************************************************************************** -***************************************************************************** -*/ - -/******* Kernel APIs ********************************************************/ - -/*============================================================================ * Set up adapter. * o detect adapter type * o set up adapter shared memory * Return: 0 ok. * < 0 error */ -/* ALEX int sdla_setup (sdlahw_t* hw, void* sfm, unsigned len)*/ -int sdla_setup (void* phw) + +int +sdla_setup(void *phw) { sdlahw_card_t* hwcard = NULL; sdlahw_t* hw = (sdlahw_t*)phw; @@ -868,27 +780,28 @@ int sdla_setup (void* phw) SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); hwcard = hw->hwcard; - switch(hwcard->type){ + switch (hwcard->type) { case SDLA_AFT: break; - + default: log(LOG_INFO, "%s: Invalid card type %x\n", hw->devname, hw->hwcard->type); - return -EINVAL; + return (-EINVAL); } hw->dpmsize = SDLA_WINDOWSIZE; - + err = sdla_detect(hw); - return err; -} + return (err); +} -/*============================================================================ +/* * Shut down SDLA: disable shared memory access and interrupts, stop CPU, etc. */ -int sdla_down (void* phw) +int +sdla_down(void *phw) { sdlahw_card_t* card = NULL; sdlahw_t* hw = (sdlahw_t*)phw; @@ -900,24 +813,25 @@ int sdla_down (void* phw) switch (card->type) { case SDLA_AFT: /* free up the allocated virtual memory */ - if (hw->status & SDLA_MEM_MAPPED){ + if (hw->status & SDLA_MEM_MAPPED) { bus_space_unmap(hw->hwcard->memt, hw->dpmbase, XILINX_PCI_MEM_SIZE); hw->status &= ~SDLA_MEM_MAPPED; } - break; + break; default: - return -EINVAL; + return (-EINVAL); } - return 0; + return (0); } -/*============================================================================ +/* * Read the hardware interrupt status. */ -int sdla_read_int_stat (void* phw, u_int32_t* int_status) +int +sdla_read_int_stat(void *phw, u_int32_t *int_status) { sdlahw_card_t* card = NULL; sdlahw_t* hw = (sdlahw_t*)phw; @@ -926,87 +840,87 @@ int sdla_read_int_stat (void* phw, u_int32_t* int_status) SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; - switch(card->type){ + switch (card->type) { case SDLA_AFT: sdla_pci_read_config_dword(hw, PCI_INT_STATUS, int_status); } - return 0; + return (0); } -/*============================================================================ +/* * Generate an interrupt to adapter's CPU. */ -int sdla_cmd (void* phw, unsigned long offset, wan_mbox_t* mbox) +int +sdla_cmd(void *phw, unsigned long offset, wan_mbox_t *mbox) { - sdlahw_t* hw = (sdlahw_t*)phw; - int len = sizeof(wan_cmd_t); - int err = 0; - u_int8_t value; - + sdlahw_t *hw = (sdlahw_t*)phw; + int len = sizeof(wan_cmd_t); + int err = 0; + u_int8_t value; + SDLA_MAGIC(hw); len += mbox->wan_data_len; - + sdla_peek(hw, offset, (void*)&value, 1); - if (value != 0x00){ + if (value != 0x00) { log(LOG_INFO, "%s: opp flag set on entry to sdla_exec!\n", hw->devname); - return 0; + return (0); } mbox->wan_opp_flag = 0x00; sdla_poke(hw, offset, (void*)mbox, len); - + err = sdla_exec(hw, offset); - if (!err){ + if (!err) { log(LOG_INFO, "%s: Command 0x%02X failed!\n", hw->devname, mbox->wan_command); - return WAN_CMD_TIMEOUT; + return (WAN_CMD_TIMEOUT); } sdla_peek(hw, offset, (void*)mbox, sizeof(wan_cmd_t)); - if (mbox->wan_data_len){ - sdla_peek(hw, offset+offsetof(wan_mbox_t, wan_data), - mbox->wan_data, mbox->wan_data_len); + if (mbox->wan_data_len) { + sdla_peek(hw, offset+offsetof(wan_mbox_t, wan_data), + mbox->wan_data, mbox->wan_data_len); } - - return mbox->wan_return_code; + + return (mbox->wan_return_code); } -/*============================================================================ +/* * Execute Adapter Command. * o Set exec flag. * o Busy-wait until flag is reset. * o Return number of loops made, or 0 if command timed out. */ -static int sdla_exec (sdlahw_t* hw, unsigned long offset) +static int +sdla_exec(sdlahw_t *hw, unsigned long offset) { volatile unsigned long tstop; volatile unsigned long nloops; u_int8_t value; - + value = 0x01; sdla_poke(hw, offset, (void*)&value, 1); tstop = ticks + EXEC_TIMEOUT; - sdla_peek(hw, offset, (void*)&value, 1); - for (nloops = 1; value == 0x01; ++ nloops){ + sdla_peek(hw, offset, (void*)&value, 1); + for (nloops = 1; value == 0x01; ++ nloops) { DELAY(EXEC_DELAY); - if (ticks > tstop || nloops > MAX_NLOOPS){ - log(LOG_INFO, "%s: Timeout %lu ticks (max=%lu) loops %lu (max=%u)\n", - hw->devname, - (ticks-tstop+EXEC_TIMEOUT), - (unsigned long)EXEC_TIMEOUT, - nloops, - MAX_NLOOPS); - return 0; /* time is up! */ + if (ticks > tstop || nloops > MAX_NLOOPS) { + log(LOG_INFO, "%s: Timeout %lu ticks (max=%lu) " + "loops %lu (max=%u)\n", hw->devname, + (ticks-tstop+EXEC_TIMEOUT), + (unsigned long)EXEC_TIMEOUT, nloops, MAX_NLOOPS); + return (0); /* time is up! */ } - sdla_peek(hw, offset, (void*)&value, 1); + sdla_peek(hw, offset, (void*)&value, 1); } - return nloops; + return (nloops); } - -/*============================================================================ + +/* * Read absolute adapter memory. * Transfer data from adapter's memory to data buffer. * @@ -1015,7 +929,8 @@ static int sdla_exec (sdlahw_t* hw, unsigned long offset) * This function is not atomic, so caller must disable interrupt if * interrupt routines are accessing adapter shared memory. */ -int sdla_peek (void* phw, unsigned long addr, void* buf, unsigned len) +int +sdla_peek(void *phw, unsigned long addr, void *buf, unsigned len) { sdlahw_card_t* card = NULL; sdlahw_t* hw = (sdlahw_t*)phw; @@ -1026,9 +941,9 @@ int sdla_peek (void* phw, unsigned long addr, void* buf, unsigned len) WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; if (addr + len > hw->memory) /* verify arguments */ - return -EINVAL; + return (-EINVAL); - switch(card->type){ + switch (card->type) { case SDLA_AFT: sdla_peek_by_4(hw, addr, buf, len); break; @@ -1038,28 +953,28 @@ int sdla_peek (void* phw, unsigned long addr, void* buf, unsigned len) __FUNCTION__,card->type); err = -EINVAL; break; - } - return err; + } + return (err); } -/*============================================================================ +/* * Read data from adapter's memory to a data buffer in 4-byte chunks. * Note that we ensure that the SDLA memory address is on a 4-byte boundary * before we begin moving the data in 4-byte chunks. */ -static void -sdla_peek_by_4 (sdlahw_t* hw, unsigned long offset, void* buf, unsigned int len) +static void +sdla_peek_by_4(sdlahw_t *hw, unsigned long offset, void *buf, unsigned int len) { /* byte copy data until we get to a 4-byte boundary */ - while (len && (offset & 0x03)){ + while (len && (offset & 0x03)) { sdla_bus_read_1(hw, offset++, (u_int8_t*)buf); - ((u_int8_t *)buf) ++; - len --; + ((u_int8_t *)buf)++; + len--; } /* copy data in 4-byte chunks */ - while (len >= 4){ + while (len >= 4) { sdla_bus_read_4(hw, offset, (u_int32_t*)buf); (u_int8_t*)buf += 4; offset += 4; @@ -1067,14 +982,14 @@ sdla_peek_by_4 (sdlahw_t* hw, unsigned long offset, void* buf, unsigned int len) } /* byte copy any remaining data */ - while (len){ + while (len) { sdla_bus_read_1(hw, offset++, (u_int8_t*)buf); - ((u_int8_t *)buf) ++; - len --; + ((u_int8_t *)buf)++; + len--; } } -/*============================================================================ +/* * Write Absolute Adapter Memory. * Transfer data from data buffer to adapter's memory. * @@ -1083,21 +998,22 @@ sdla_peek_by_4 (sdlahw_t* hw, unsigned long offset, void* buf, unsigned int len) * This function is not atomic, so caller must disable interrupt if * interrupt routines are accessing adapter shared memory. */ -int sdla_poke (void* phw, unsigned long addr, void* buf, unsigned len) +int +sdla_poke(void *phw, unsigned long addr, void *buf, unsigned len) { sdlahw_card_t* card = NULL; sdlahw_t* hw = (sdlahw_t*)phw; - int err = 0; + int err = 0; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; - if (addr + len > hw->memory){ /* verify arguments */ - return -EINVAL; + if (addr + len > hw->memory) { /* verify arguments */ + return (-EINVAL); } - - switch (card->type){ + + switch (card->type) { case SDLA_AFT: sdla_poke_by_4(hw, addr, buf, len); break; @@ -1108,26 +1024,27 @@ int sdla_poke (void* phw, unsigned long addr, void* buf, unsigned len) err = -EINVAL; break; } - return err; + return (err); } -/*============================================================================ +/* * Write from a data buffer to adapter's memory in 4-byte chunks. * Note that we ensure that the SDLA memory address is on a 4-byte boundary * before we begin moving the data in 4-byte chunks. */ -static void sdla_poke_by_4 (sdlahw_t* hw, unsigned long offset, void* buf, unsigned int len) +static void +sdla_poke_by_4(sdlahw_t *hw, unsigned long offset, void *buf, unsigned int len) { /* byte copy data until we get to a 4-byte boundary */ - while (len && (offset & 0x03)){ + while (len && (offset & 0x03)) { sdla_bus_write_1(hw, offset++, *(char *)buf); ((char *)buf) ++; len --; } /* copy data in 4-byte chunks */ - while (len >= 4){ + while (len >= 4) { sdla_bus_write_4(hw, offset, *(unsigned long *)buf); offset += 4; (char*)buf += 4; @@ -1135,27 +1052,29 @@ static void sdla_poke_by_4 (sdlahw_t* hw, unsigned long offset, void* buf, unsig } /* byte copy any remaining data */ - while (len){ + while (len) { sdla_bus_write_1(hw, offset++, *(char *)buf); ((char *)buf) ++; len --; } } -int sdla_poke_byte (void* phw, unsigned long offset, u_int8_t value) +int +sdla_poke_byte(void *phw, unsigned long offset, u_int8_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; SDLA_MAGIC(hw); /* Sangoma ISA card sdla_bus_write_1(hw, offset, value); */ sdla_poke(hw, offset, (void*)&value, 1); - return 0; + return (0); } -int sdla_set_bit (void* phw, unsigned long offset, u_int8_t value) +int +sdla_set_bit(void *phw, unsigned long offset, u_int8_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; - u_int8_t tmp; + sdlahw_t *hw = (sdlahw_t*)phw; + u_int8_t tmp; SDLA_MAGIC(hw); /* Sangoma ISA card -> sdla_bus_read_1(hw, offset, &tmp); */ @@ -1163,14 +1082,14 @@ int sdla_set_bit (void* phw, unsigned long offset, u_int8_t value) tmp |= value; /* Sangoma ISA card -> sdla_bus_write_1(hw, offset, tmp); */ sdla_poke(hw, offset, (void*)&tmp, 1); - return 0; + return (0); } - -int sdla_clear_bit (void* phw, unsigned long offset, u_int8_t value) +int +sdla_clear_bit(void *phw, unsigned long offset, u_int8_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; - u_int8_t tmp; + sdlahw_t *hw = (sdlahw_t*)phw; + u_int8_t tmp; SDLA_MAGIC(hw); /* Sangoma ISA card -> sdla_bus_read_1(hw, offset, &tmp); */ @@ -1178,198 +1097,173 @@ int sdla_clear_bit (void* phw, unsigned long offset, u_int8_t value) tmp &= ~value; /* Sangoma ISA card -> sdla_bus_write_1(hw, offset, tmp); */ sdla_poke(hw, offset, (void*)&tmp, 1); - return 0; + return (0); } - -/****** Hardware-Specific Functions *****************************************/ - /* -***************************************************************************** -***************************************************************************** -*** S A N G O M A H A R D W A R E D E T E C T I O N ***** -***************************************************************************** -***************************************************************************** -*/ - -/*============================================================================ * Find the AFT HDLC PCI adapter in the PCI bus. * Return the number of AFT adapters found (0 if no adapter found). */ -static int sdla_detect_aft(sdlahw_t* hw) +static int +sdla_detect_aft(sdlahw_t *hw) { - sdlahw_card_t* card; - u_int16_t ut_u16; + sdlahw_card_t *card; + u_int16_t ut_u16; WAN_ASSERT(hw == NULL); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; sdla_pci_read_config_dword(hw, - (hw->cpu_no == SDLA_CPU_A) ? PCI_IO_BASE_DWORD : - PCI_MEM_BASE0_DWORD, (u_int32_t*)&hw->mem_base_addr); - if (!hw->mem_base_addr){ - if(hw->cpu_no == SDLA_CPU_B){ + (hw->cpu_no == SDLA_CPU_A) ? PCI_IO_BASE_DWORD : + PCI_MEM_BASE0_DWORD, (u_int32_t*)&hw->mem_base_addr); + if (!hw->mem_base_addr) { + if (hw->cpu_no == SDLA_CPU_B) { printf("%s: No PCI memory allocated for CPU #B\n", hw->devname); - }else{ + } else { printf("%s: No PCI memory allocated to card\n", hw->devname); } - return -EINVAL; + return (-EINVAL); } -#if defined(DEBUG) +#ifdef DEBUG log(LOG_INFO, "%s: AFT PCI memory at 0x%lX\n", hw->devname, (unsigned long)hw->mem_base_addr); -#endif +#endif /* DEBUG */ sdla_pci_read_config_byte(hw, PCI_INTLINE, (u_int8_t*)&hw->irq); - if(hw->irq == PCI_IRQ_NOT_ALLOCATED) { - printf("%s: IRQ not allocated to AFT adapter\n", - hw->devname); - return -EINVAL; - } - -#if defined(DEBUG) - log(LOG_INFO, "%s: IRQ %d allocated to the AFT PCI card\n", - hw->devname, hw->irq); -#endif + if (hw->irq == PCI_IRQ_NOT_ALLOCATED) { + printf("%s: IRQ not allocated to AFT adapter\n", hw->devname); + return (-EINVAL); + } + +#ifdef DEBUG + log(LOG_INFO, "%s: IRQ %d allocated to the AFT PCI card\n", + hw->devname, hw->irq); +#endif /* DEBUG */ hw->memory=XILINX_PCI_MEM_SIZE; - - /* map the physical PCI memory to virtual memory */ - bus_space_map(hw->hwcard->memt, - hw->mem_base_addr, - XILINX_PCI_MEM_SIZE, - 0, - &hw->dpmbase); - if (!hw->dpmbase){ - printf("%s: couldn't map memory\n", - hw->devname); - return -EINVAL; + + /* Map the physical PCI memory to virtual memory */ + bus_space_map(hw->hwcard->memt, hw->mem_base_addr, XILINX_PCI_MEM_SIZE, + 0, &hw->dpmbase); + if (!hw->dpmbase) { + printf("%s: couldn't map memory\n", hw->devname); + return (-EINVAL); } hw->status |= SDLA_MEM_MAPPED; - /* Enable master operation on PCI and enable - * bar0 memory */ + /* Enable master operation on PCI and enable bar0 memory */ sdla_pci_read_config_word(hw, XILINX_PCI_CMD_REG, &ut_u16); ut_u16 |=0x06; sdla_pci_write_config_word(hw, XILINX_PCI_CMD_REG, ut_u16); /* Set PCI Latency of 0xFF*/ - sdla_pci_write_config_dword(hw, XILINX_PCI_LATENCY_REG, XILINX_PCI_LATENCY); + sdla_pci_write_config_dword(hw, XILINX_PCI_LATENCY_REG, + XILINX_PCI_LATENCY); - return 0; + return (0); } -/* - * ============================================================================ +/* * Detect adapter type. */ -static int sdla_detect (sdlahw_t* hw) +static int +sdla_detect(sdlahw_t *hw) { - sdlahw_card_t* card = NULL; - int err = 0; + sdlahw_card_t *card = NULL; + int err = 0; WAN_ASSERT(hw == NULL); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; - switch (card->type){ + switch (card->type) { case SDLA_AFT: err = sdla_detect_aft(hw); break; } - if (err){ + if (err) { sdla_down(hw); } - return err; + return (err); } - - - -/* -***************************************************************************** -***************************************************************************** -*** H A R D W A R E C O N F I G U R A T I O N ***** -***************************************************************************** -***************************************************************************** -*/ - -int sdla_is_te1(void* phw) +int +sdla_is_te1(void *phw) { - sdlahw_card_t* hwcard = NULL; - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_card_t *hwcard = NULL; + sdlahw_t *hw = (sdlahw_t*)phw; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); hwcard = hw->hwcard; - switch(hwcard->atype){ + switch (hwcard->atype) { case S5144_ADPTR_1_CPU_T1E1: case S5147_ADPTR_2_CPU_T1E1: case S5148_ADPTR_1_CPU_T1E1: case A101_ADPTR_1TE1: case A101_ADPTR_2TE1: - return 1; + return (1); } - return 0; - - + return (0); } -int sdla_check_mismatch(void* phw, unsigned char media) +int +sdla_check_mismatch(void *phw, unsigned char media) { - sdlahw_card_t* hwcard = NULL; - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_card_t *hwcard = NULL; + sdlahw_t *hw = (sdlahw_t*)phw; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); hwcard = hw->hwcard; - if (media == WANOPT_MEDIA_T1 || - media == WANOPT_MEDIA_E1){ + if (media == WANOPT_MEDIA_T1 || + media == WANOPT_MEDIA_E1) { if (hwcard->atype != S5144_ADPTR_1_CPU_T1E1 && hwcard->atype != S5147_ADPTR_2_CPU_T1E1 && - hwcard->atype != S5148_ADPTR_1_CPU_T1E1){ - log(LOG_INFO, "%s: Error: Card type mismatch: User=T1/E1 Actual=%s\n", - hw->devname, - SDLA_ADPTR_DECODE(hwcard->atype)); - return -EIO; + hwcard->atype != S5148_ADPTR_1_CPU_T1E1) { + log(LOG_INFO, "%s: Error: Card type mismatch: " + "User=T1/E1 Actual=%s\n", hw->devname, + SDLA_ADPTR_DECODE(hwcard->atype)); + return (-EIO); } hwcard->atype = S5144_ADPTR_1_CPU_T1E1; - - }else if (media == WANOPT_MEDIA_56K){ - if (hwcard->atype != S5145_ADPTR_1_CPU_56K){ - log(LOG_INFO, "%s: Error: Card type mismatch: User=56K Actual=%s\n", - hw->devname, - SDLA_ADPTR_DECODE(hwcard->atype)); - return -EIO; + + }else if (media == WANOPT_MEDIA_56K) { + if (hwcard->atype != S5145_ADPTR_1_CPU_56K) { + log(LOG_INFO, "%s: Error: Card type mismatch: " + "User=56K Actual=%s\n", hw->devname, + SDLA_ADPTR_DECODE(hwcard->atype)); + return (-EIO); } }else{ if (hwcard->atype == S5145_ADPTR_1_CPU_56K || hwcard->atype == S5144_ADPTR_1_CPU_T1E1 || hwcard->atype == S5147_ADPTR_2_CPU_T1E1 || - hwcard->atype == S5148_ADPTR_1_CPU_T1E1){ - log(LOG_INFO, "%s: Error: Card type mismatch: User=S514(1/2/3) Actual=%s\n", - hw->devname, - SDLA_ADPTR_DECODE(hwcard->atype)); - return -EIO; + hwcard->atype == S5148_ADPTR_1_CPU_T1E1) { + log(LOG_INFO, "%s: Error: Card type mismatch: " + "User=S514(1/2/3) Actual=%s\n", hw->devname, + SDLA_ADPTR_DECODE(hwcard->atype)); + return (-EIO); } } - return 0; + return (0); } -int sdla_getcfg(void* phw, int type, void* value) +int +sdla_getcfg(void *phw, int type, void *value) { sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* hwcard; + sdlahw_card_t *hwcard; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); hwcard = hw->hwcard; - switch(type){ + switch (type) { case SDLA_CARDTYPE: *(u_int16_t*)value = hwcard->type; break; @@ -1377,7 +1271,8 @@ int sdla_getcfg(void* phw, int type, void* value) *(bus_space_handle_t*)value = hw->dpmbase; break; case SDLA_MEMEND: - *(u_int32_t*)value = ((unsigned long)hw->dpmbase + hw->dpmsize - 1); + *(u_int32_t*)value = ((unsigned long)hw->dpmbase + + hw->dpmsize - 1); break; case SDLA_MEMSIZE: *(u_int16_t*)value = hw->dpmsize; @@ -1410,128 +1305,136 @@ int sdla_getcfg(void* phw, int type, void* value) *(u_int32_t*)value = hw->mem_base_addr; break; } - return 0; + return (0); } -int sdla_get_hwcard(void* phw, void** phwcard) +int +sdla_get_hwcard(void *phw, void **phwcard) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); *phwcard = hw->hwcard; - return 0; + return (0); } -int sdla_get_hwprobe(void* phw, void** str) +int +sdla_get_hwprobe(void *phw, void **str) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); - if (hw->hwprobe){ + if (hw->hwprobe) { *str = hw->hwprobe->hw_info; } - return 0; + return (0); } -/* -***************************************************************************** -***************************************************************************** -*** M I S C E L L A N E O U S ***** -***************************************************************************** -***************************************************************************** -*/ - -int sdla_bus_write_1(void* phw, unsigned int offset, u_int8_t value) +int +sdla_bus_write_1(void *phw, unsigned int offset, u_int8_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; - - WAN_ASSERT(hw == NULL); + sdlahw_t *hw = (sdlahw_t*)phw; + + WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); bus_space_write_1(hw->hwcard->memt, hw->dpmbase, offset, value); - return 0; + return (0); } -int sdla_bus_write_2(void* phw, unsigned int offset, u_int16_t value) +int +sdla_bus_write_2(void *phw, unsigned int offset, u_int16_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; - WAN_ASSERT(hw == NULL); + WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); bus_space_write_2(hw->hwcard->memt, hw->dpmbase, offset, value); - return 0; + return (0); } -int sdla_bus_write_4(void* phw, unsigned int offset, u_int32_t value) +int +sdla_bus_write_4(void *phw, unsigned int offset, u_int32_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; - WAN_ASSERT(hw == NULL); + WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); bus_space_write_4(hw->hwcard->memt, hw->dpmbase, offset, value); - return 0; + return (0); } -int sdla_bus_read_1(void* phw, unsigned int offset, u_int8_t* value) +int +sdla_bus_read_1(void *phw, unsigned int offset, u_int8_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; - WAN_ASSERT2(hw == NULL, 0); + WAN_ASSERT2(hw == NULL, 0); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; - *value = bus_space_read_1(hw->hwcard->memt, hw->dpmbase, offset); - return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); + *value = bus_space_read_1(hw->hwcard->memt, hw->dpmbase, offset); + return (0); } -int sdla_bus_read_2(void* phw, unsigned int offset, u_int16_t* value) +int +sdla_bus_read_2(void *phw, unsigned int offset, u_int16_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; - WAN_ASSERT2(hw == NULL, 0); + WAN_ASSERT2(hw == NULL, 0); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; - *value = bus_space_read_2(hw->hwcard->memt, hw->dpmbase, offset); - return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); + *value = bus_space_read_2(hw->hwcard->memt, hw->dpmbase, offset); + return (0); } -int sdla_bus_read_4(void* phw, unsigned int offset, u_int32_t* value) +int +sdla_bus_read_4(void *phw, unsigned int offset, u_int32_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; + sdlahw_t *hw = (sdlahw_t*)phw; - WAN_ASSERT2(hw == NULL, 0); - WAN_ASSERT2(hw->dpmbase == 0, 0); + WAN_ASSERT2(hw == NULL, 0); + WAN_ASSERT2(hw->dpmbase == 0, 0); SDLA_MAGIC(hw); - if (!(hw->status & SDLA_MEM_MAPPED)) return 0; - *value = bus_space_read_4(hw->hwcard->memt, hw->dpmbase, offset); - return 0; + if (!(hw->status & SDLA_MEM_MAPPED)) + return (0); + *value = bus_space_read_4(hw->hwcard->memt, hw->dpmbase, offset); + return (0); } -static int sdla_pci_read_config_dword(void* phw, int reg, u_int32_t* value) +static int +sdla_pci_read_config_dword(void *phw, int reg, u_int32_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* hwcard; + sdlahw_t *hw = (sdlahw_t*)phw; + sdlahw_card_t *hwcard; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); hwcard = hw->hwcard; *value = pci_conf_read(hwcard->pa.pa_pc, hwcard->pa.pa_tag, reg); - return 0; + return (0); } -static int sdla_pci_read_config_word(void* phw, int reg, u_int16_t* value) +static int +sdla_pci_read_config_word(void *phw, int reg, u_int16_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* hwcard; - u_int32_t tmp = 0x00; + sdlahw_t *hw = (sdlahw_t*)phw; + sdlahw_card_t *hwcard; + u_int32_t tmp = 0x00; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); @@ -1539,14 +1442,15 @@ static int sdla_pci_read_config_word(void* phw, int reg, u_int16_t* value) hwcard = hw->hwcard; tmp = pci_conf_read(hwcard->pa.pa_pc, hwcard->pa.pa_tag, reg); *value = (u_int16_t)((tmp >> 16) & 0xFFFF); - return 0; + return (0); } -static int sdla_pci_read_config_byte(void* phw, int reg, u_int8_t* value) +static int +sdla_pci_read_config_byte(void *phw, int reg, u_int8_t *value) { - sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* hwcard; - u_int32_t tmp = 0x00; + sdlahw_t *hw = (sdlahw_t*)phw; + sdlahw_card_t *hwcard; + u_int32_t tmp = 0x00; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); @@ -1554,33 +1458,33 @@ static int sdla_pci_read_config_byte(void* phw, int reg, u_int8_t* value) hwcard = hw->hwcard; tmp = pci_conf_read(hwcard->pa.pa_pc, hwcard->pa.pa_tag, reg); *value = (u_int8_t)(tmp & 0xFF); - return 0; + return (0); } -static int sdla_pci_write_config_dword(void* phw, int reg, u_int32_t value) +static int +sdla_pci_write_config_dword(void *phw, int reg, u_int32_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* card; + sdlahw_t *hw = (sdlahw_t*)phw; + sdlahw_card_t *card; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; - pci_conf_write(card->pa.pa_pc, card->pa.pa_tag, reg, value); - return 0; + pci_conf_write(card->pa.pa_pc, card->pa.pa_tag, reg, value); + return (0); } -static int sdla_pci_write_config_word(void* phw, int reg, u_int16_t value) +static int +sdla_pci_write_config_word(void *phw, int reg, u_int16_t value) { - sdlahw_t* hw = (sdlahw_t*)phw; - sdlahw_card_t* card; + sdlahw_t *hw = (sdlahw_t*)phw; + sdlahw_card_t *card; WAN_ASSERT(hw == NULL); SDLA_MAGIC(hw); WAN_ASSERT(hw->hwcard == NULL); card = hw->hwcard; - pci_conf_write(card->pa.pa_pc, card->pa.pa_tag, reg, value); - return 0; + pci_conf_write(card->pa.pa_pc, card->pa.pa_tag, reg, value); + return (0); } - - -- cgit v1.2.3