![Marcelo Feitoza Parisi](/assets/img/avatar_default.png)
From: Marcelo Feitoza Parisi <marcelo@feitoza.com.br> Use of the time_after() macro, defined at linux/jiffies.h, which deal with wrapping correctly and are nicer to read. Signed-off-by: Marcelo Feitoza Parisi <marcelo@feitoza.com.br> Signed-off-by: Domen Puncer <domen@coderock.org> Signed-off-by: David S. Miller <davem@davemloft.net>
346 lines
9.8 KiB
C
346 lines
9.8 KiB
C
/*****************************************************************************
|
|
* sdla_chdlc.c WANPIPE(tm) Multiprotocol WAN Link Driver. Cisco HDLC module.
|
|
*
|
|
* Authors: Nenad Corbic <ncorbic@sangoma.com>
|
|
* Gideon Hack
|
|
*
|
|
* Copyright: (c) 1995-1999 Sangoma Technologies Inc.
|
|
*
|
|
* 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.
|
|
* ============================================================================
|
|
* Sep 30, 1999 Nenad Corbic Fixed dynamic IP and route setup.
|
|
* Sep 23, 1999 Nenad Corbic Added SMP support, fixed tracing
|
|
* Sep 13, 1999 Nenad Corbic Split up Port 0 and 1 into separate devices.
|
|
* Jun 02, 1999 Gideon Hack Added support for the S514 adapter.
|
|
* Oct 30, 1998 Jaspreet Singh Added Support for CHDLC API (HDLC STREAMING).
|
|
* Oct 28, 1998 Jaspreet Singh Added Support for Dual Port CHDLC.
|
|
* Aug 07, 1998 David Fong Initial version.
|
|
*****************************************************************************/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h> /* printk(), and other useful stuff */
|
|
#include <linux/stddef.h> /* offsetof(), etc. */
|
|
#include <linux/errno.h> /* return codes */
|
|
#include <linux/string.h> /* inline memset(), etc. */
|
|
#include <linux/slab.h> /* kmalloc(), kfree() */
|
|
#include <linux/wanrouter.h> /* WAN router definitions */
|
|
#include <linux/wanpipe.h> /* WANPIPE common user API definitions */
|
|
#include <linux/if_arp.h> /* ARPHRD_* defines */
|
|
#include <linux/jiffies.h> /* time_after() macro */
|
|
|
|
#include <linux/inetdevice.h>
|
|
#include <asm/uaccess.h>
|
|
|
|
#include <linux/in.h> /* sockaddr_in */
|
|
#include <linux/inet.h>
|
|
#include <linux/if.h>
|
|
#include <asm/byteorder.h> /* htons(), etc. */
|
|
#include <linux/sdlapci.h>
|
|
#include <asm/io.h>
|
|
|
|
#include <linux/sdla_chdlc.h> /* CHDLC firmware API definitions */
|
|
|
|
/****** Defines & Macros ****************************************************/
|
|
|
|
/* reasons for enabling the timer interrupt on the adapter */
|
|
#define TMR_INT_ENABLED_UDP 0x0001
|
|
#define TMR_INT_ENABLED_UPDATE 0x0002
|
|
|
|
#define CHDLC_DFLT_DATA_LEN 1500 /* default MTU */
|
|
#define CHDLC_HDR_LEN 1
|
|
|
|
#define IFF_POINTTOPOINT 0x10
|
|
|
|
#define WANPIPE 0x00
|
|
#define API 0x01
|
|
#define CHDLC_API 0x01
|
|
|
|
#define PORT(x) (x == 0 ? "PRIMARY" : "SECONDARY" )
|
|
|
|
|
|
/******Data Structures*****************************************************/
|
|
|
|
/* This structure is placed in the private data area of the device structure.
|
|
* The card structure used to occupy the private area but now the following
|
|
* structure will incorporate the card structure along with CHDLC specific data
|
|
*/
|
|
|
|
typedef struct chdlc_private_area
|
|
{
|
|
struct net_device *slave;
|
|
sdla_t *card;
|
|
int TracingEnabled; /* For enabling Tracing */
|
|
unsigned long curr_trace_addr; /* Used for Tracing */
|
|
unsigned long start_trace_addr;
|
|
unsigned long end_trace_addr;
|
|
unsigned long base_addr_trace_buffer;
|
|
unsigned long end_addr_trace_buffer;
|
|
unsigned short number_trace_elements;
|
|
unsigned available_buffer_space;
|
|
unsigned long router_start_time;
|
|
unsigned char route_status;
|
|
unsigned char route_removed;
|
|
unsigned long tick_counter; /* For 5s timeout counter */
|
|
unsigned long router_up_time;
|
|
u32 IP_address; /* IP addressing */
|
|
u32 IP_netmask;
|
|
unsigned char mc; /* Mulitcast support on/off */
|
|
unsigned short udp_pkt_lgth; /* udp packet processing */
|
|
char udp_pkt_src;
|
|
char udp_pkt_data[MAX_LGTH_UDP_MGNT_PKT];
|
|
unsigned short timer_int_enabled;
|
|
char update_comms_stats; /* updating comms stats */
|
|
//FIXME: add driver stats as per frame relay!
|
|
|
|
} chdlc_private_area_t;
|
|
|
|
/* Route Status options */
|
|
#define NO_ROUTE 0x00
|
|
#define ADD_ROUTE 0x01
|
|
#define ROUTE_ADDED 0x02
|
|
#define REMOVE_ROUTE 0x03
|
|
|
|
|
|
/****** Function Prototypes *************************************************/
|
|
/* WAN link driver entry points. These are called by the WAN router module. */
|
|
static int wpft1_exec (struct sdla *card, void *u_cmd, void *u_data);
|
|
static int chdlc_read_version (sdla_t* card, char* str);
|
|
static int chdlc_error (sdla_t *card, int err, CHDLC_MAILBOX_STRUCT *mb);
|
|
|
|
/****** Public Functions ****************************************************/
|
|
|
|
/*============================================================================
|
|
* Cisco HDLC protocol initialization routine.
|
|
*
|
|
* This routine is called by the main WANPIPE module during setup. At this
|
|
* point adapter is completely initialized and firmware is running.
|
|
* o read firmware version (to make sure it's alive)
|
|
* o configure adapter
|
|
* o initialize protocol-specific fields of the adapter data space.
|
|
*
|
|
* Return: 0 o.k.
|
|
* < 0 failure.
|
|
*/
|
|
int wpft1_init (sdla_t* card, wandev_conf_t* conf)
|
|
{
|
|
unsigned char port_num;
|
|
int err;
|
|
|
|
union
|
|
{
|
|
char str[80];
|
|
} u;
|
|
volatile CHDLC_MAILBOX_STRUCT* mb;
|
|
CHDLC_MAILBOX_STRUCT* mb1;
|
|
unsigned long timeout;
|
|
|
|
/* Verify configuration ID */
|
|
if (conf->config_id != WANCONFIG_CHDLC) {
|
|
printk(KERN_INFO "%s: invalid configuration ID %u!\n",
|
|
card->devname, conf->config_id);
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Use primary port */
|
|
card->u.c.comm_port = 0;
|
|
|
|
|
|
/* Initialize protocol-specific fields */
|
|
if(card->hw.type != SDLA_S514){
|
|
card->mbox = (void *) card->hw.dpmbase;
|
|
}else{
|
|
card->mbox = (void *) card->hw.dpmbase + PRI_BASE_ADDR_MB_STRUCT;
|
|
}
|
|
|
|
mb = mb1 = card->mbox;
|
|
|
|
if (!card->configured){
|
|
|
|
/* The board will place an 'I' in the return code to indicate that it is
|
|
ready to accept commands. We expect this to be completed in less
|
|
than 1 second. */
|
|
|
|
timeout = jiffies;
|
|
while (mb->return_code != 'I') /* Wait 1s for board to initialize */
|
|
if (time_after(jiffies, timeout + 1*HZ)) break;
|
|
|
|
if (mb->return_code != 'I') {
|
|
printk(KERN_INFO
|
|
"%s: Initialization not completed by adapter\n",
|
|
card->devname);
|
|
printk(KERN_INFO "Please contact Sangoma representative.\n");
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
/* Read firmware version. Note that when adapter initializes, it
|
|
* clears the mailbox, so it may appear that the first command was
|
|
* executed successfully when in fact it was merely erased. To work
|
|
* around this, we execute the first command twice.
|
|
*/
|
|
|
|
if (chdlc_read_version(card, u.str))
|
|
return -EIO;
|
|
|
|
printk(KERN_INFO "%s: Running FT1 Configuration firmware v%s\n",
|
|
card->devname, u.str);
|
|
|
|
card->isr = NULL;
|
|
card->poll = NULL;
|
|
card->exec = &wpft1_exec;
|
|
card->wandev.update = NULL;
|
|
card->wandev.new_if = NULL;
|
|
card->wandev.del_if = NULL;
|
|
card->wandev.state = WAN_DUALPORT;
|
|
card->wandev.udp_port = conf->udp_port;
|
|
|
|
card->wandev.new_if_cnt = 0;
|
|
|
|
/* This is for the ports link state */
|
|
card->u.c.state = WAN_DISCONNECTED;
|
|
|
|
/* reset the number of times the 'update()' proc has been called */
|
|
card->u.c.update_call_count = 0;
|
|
|
|
card->wandev.ttl = 0x7F;
|
|
card->wandev.interface = 0;
|
|
|
|
card->wandev.clocking = 0;
|
|
|
|
port_num = card->u.c.comm_port;
|
|
|
|
/* Setup Port Bps */
|
|
|
|
card->wandev.bps = 0;
|
|
|
|
card->wandev.mtu = MIN_LGTH_CHDLC_DATA_CFG;
|
|
|
|
/* Set up the interrupt status area */
|
|
/* Read the CHDLC Configuration and obtain:
|
|
* Ptr to shared memory infor struct
|
|
* Use this pointer to calculate the value of card->u.c.flags !
|
|
*/
|
|
mb1->buffer_length = 0;
|
|
mb1->command = READ_CHDLC_CONFIGURATION;
|
|
err = sdla_exec(mb1) ? mb1->return_code : CMD_TIMEOUT;
|
|
if(err != COMMAND_OK) {
|
|
chdlc_error(card, err, mb1);
|
|
return -EIO;
|
|
}
|
|
|
|
if(card->hw.type == SDLA_S514){
|
|
card->u.c.flags = (void *)(card->hw.dpmbase +
|
|
(((CHDLC_CONFIGURATION_STRUCT *)mb1->data)->
|
|
ptr_shared_mem_info_struct));
|
|
}else{
|
|
card->u.c.flags = (void *)(card->hw.dpmbase +
|
|
(((CHDLC_CONFIGURATION_STRUCT *)mb1->data)->
|
|
ptr_shared_mem_info_struct % SDLA_WINDOWSIZE));
|
|
}
|
|
|
|
card->wandev.state = WAN_FT1_READY;
|
|
printk(KERN_INFO "%s: FT1 Config Ready !\n",card->devname);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int wpft1_exec(sdla_t *card, void *u_cmd, void *u_data)
|
|
{
|
|
CHDLC_MAILBOX_STRUCT* mbox = card->mbox;
|
|
int len;
|
|
|
|
if (copy_from_user((void*)&mbox->command, u_cmd, sizeof(ft1_exec_cmd_t))){
|
|
return -EFAULT;
|
|
}
|
|
|
|
len = mbox->buffer_length;
|
|
|
|
if (len) {
|
|
if( copy_from_user((void*)&mbox->data, u_data, len)){
|
|
return -EFAULT;
|
|
}
|
|
}
|
|
|
|
/* execute command */
|
|
if (!sdla_exec(mbox)){
|
|
return -EIO;
|
|
}
|
|
|
|
/* return result */
|
|
if( copy_to_user(u_cmd, (void*)&mbox->command, sizeof(ft1_exec_cmd_t))){
|
|
return -EFAULT;
|
|
}
|
|
|
|
len = mbox->buffer_length;
|
|
|
|
if (len && u_data && copy_to_user(u_data, (void*)&mbox->data, len)){
|
|
return -EFAULT;
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/*============================================================================
|
|
* Read firmware code version.
|
|
* Put code version as ASCII string in str.
|
|
*/
|
|
static int chdlc_read_version (sdla_t* card, char* str)
|
|
{
|
|
CHDLC_MAILBOX_STRUCT* mb = card->mbox;
|
|
int len;
|
|
char err;
|
|
mb->buffer_length = 0;
|
|
mb->command = READ_CHDLC_CODE_VERSION;
|
|
err = sdla_exec(mb) ? mb->return_code : CMD_TIMEOUT;
|
|
|
|
if(err != COMMAND_OK) {
|
|
chdlc_error(card,err,mb);
|
|
}
|
|
else if (str) { /* is not null */
|
|
len = mb->buffer_length;
|
|
memcpy(str, mb->data, len);
|
|
str[len] = '\0';
|
|
}
|
|
return (err);
|
|
}
|
|
|
|
/*============================================================================
|
|
* Firmware error handler.
|
|
* This routine is called whenever firmware command returns non-zero
|
|
* return code.
|
|
*
|
|
* Return zero if previous command has to be cancelled.
|
|
*/
|
|
static int chdlc_error (sdla_t *card, int err, CHDLC_MAILBOX_STRUCT *mb)
|
|
{
|
|
unsigned cmd = mb->command;
|
|
|
|
switch (err) {
|
|
|
|
case CMD_TIMEOUT:
|
|
printk(KERN_ERR "%s: command 0x%02X timed out!\n",
|
|
card->devname, cmd);
|
|
break;
|
|
|
|
case S514_BOTH_PORTS_SAME_CLK_MODE:
|
|
if(cmd == SET_CHDLC_CONFIGURATION) {
|
|
printk(KERN_INFO
|
|
"%s: Configure both ports for the same clock source\n",
|
|
card->devname);
|
|
break;
|
|
}
|
|
|
|
default:
|
|
printk(KERN_INFO "%s: command 0x%02X returned 0x%02X!\n",
|
|
card->devname, cmd, err);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
MODULE_LICENSE("GPL");
|