799 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			799 lines
		
	
	
		
			23 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/* $Id: hycapi.c,v 1.8.6.4 2001/09/23 22:24:54 kai Exp $
 | 
						|
 *
 | 
						|
 * Linux driver for HYSDN cards, CAPI2.0-Interface.
 | 
						|
 *
 | 
						|
 * Author    Ulrich Albrecht <u.albrecht@hypercope.de> for Hypercope GmbH
 | 
						|
 * Copyright 2000 by Hypercope GmbH
 | 
						|
 *
 | 
						|
 * This software may be used and distributed according to the terms
 | 
						|
 * of the GNU General Public License, incorporated herein by reference.
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/module.h>
 | 
						|
#include <linux/signal.h>
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <linux/skbuff.h>
 | 
						|
#include <linux/netdevice.h>
 | 
						|
 | 
						|
#define	VER_DRIVER	0
 | 
						|
#define	VER_CARDTYPE	1
 | 
						|
#define	VER_HWID	2
 | 
						|
#define	VER_SERIAL	3
 | 
						|
#define	VER_OPTION	4
 | 
						|
#define	VER_PROTO	5
 | 
						|
#define	VER_PROFILE	6
 | 
						|
#define	VER_CAPI	7
 | 
						|
 | 
						|
#include "hysdn_defs.h"
 | 
						|
#include <linux/kernelcapi.h>
 | 
						|
 | 
						|
static char hycapi_revision[]="$Revision: 1.8.6.4 $";
 | 
						|
 | 
						|
unsigned int hycapi_enable = 0xffffffff; 
 | 
						|
module_param(hycapi_enable, uint, 0);
 | 
						|
 | 
						|
typedef struct _hycapi_appl {
 | 
						|
	unsigned int ctrl_mask;
 | 
						|
	capi_register_params rp;
 | 
						|
	struct sk_buff *listen_req[CAPI_MAXCONTR];
 | 
						|
} hycapi_appl;
 | 
						|
 | 
						|
static hycapi_appl hycapi_applications[CAPI_MAXAPPL];
 | 
						|
 | 
						|
static u16 hycapi_send_message(struct capi_ctr *ctrl, struct sk_buff *skb);
 | 
						|
 | 
						|
static inline int _hycapi_appCheck(int app_id, int ctrl_no)
 | 
						|
{
 | 
						|
	if((ctrl_no <= 0) || (ctrl_no > CAPI_MAXCONTR) || (app_id <= 0) ||
 | 
						|
	   (app_id > CAPI_MAXAPPL))
 | 
						|
	{
 | 
						|
		printk(KERN_ERR "HYCAPI: Invalid request app_id %d for controller %d", app_id, ctrl_no);
 | 
						|
		return -1;
 | 
						|
	}
 | 
						|
	return ((hycapi_applications[app_id-1].ctrl_mask & (1 << (ctrl_no-1))) != 0);
 | 
						|
}
 | 
						|
 | 
						|
/******************************
 | 
						|
Kernel-Capi callback reset_ctr
 | 
						|
******************************/     
 | 
						|
 | 
						|
static void
 | 
						|
hycapi_reset_ctr(struct capi_ctr *ctrl)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = ctrl->driverdata;
 | 
						|
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "HYCAPI hycapi_reset_ctr\n");
 | 
						|
#endif
 | 
						|
	capilib_release(&cinfo->ncci_head);
 | 
						|
	capi_ctr_down(ctrl);
 | 
						|
}
 | 
						|
 | 
						|
/******************************
 | 
						|
Kernel-Capi callback remove_ctr
 | 
						|
******************************/     
 | 
						|
 | 
						|
static void
 | 
						|
hycapi_remove_ctr(struct capi_ctr *ctrl)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	hycapictrl_info *cinfo = NULL;
 | 
						|
	hysdn_card *card = NULL;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "HYCAPI hycapi_remove_ctr\n");
 | 
						|
#endif 
 | 
						|
	cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	if(!cinfo) {
 | 
						|
		printk(KERN_ERR "No hycapictrl_info set!");
 | 
						|
		return;
 | 
						|
	}    
 | 
						|
	card = cinfo->card;
 | 
						|
	capi_ctr_suspend_output(ctrl);
 | 
						|
	for(i=0; i<CAPI_MAXAPPL;i++) {
 | 
						|
		if(hycapi_applications[i].listen_req[ctrl->cnr-1]) {
 | 
						|
			kfree_skb(hycapi_applications[i].listen_req[ctrl->cnr-1]);
 | 
						|
			hycapi_applications[i].listen_req[ctrl->cnr-1] = NULL;
 | 
						|
		}
 | 
						|
	}
 | 
						|
	detach_capi_ctr(ctrl);
 | 
						|
	ctrl->driverdata = NULL;
 | 
						|
	kfree(card->hyctrlinfo);
 | 
						|
 | 
						|
		
 | 
						|
	card->hyctrlinfo = NULL;
 | 
						|
}
 | 
						|
 | 
						|
/***********************************************************
 | 
						|
 | 
						|
Queue a CAPI-message to the controller.
 | 
						|
 | 
						|
***********************************************************/
 | 
						|
 | 
						|
static void
 | 
						|
hycapi_sendmsg_internal(struct capi_ctr *ctrl, struct sk_buff *skb)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	hysdn_card *card = cinfo->card;
 | 
						|
 | 
						|
	spin_lock_irq(&cinfo->lock);
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_send_message\n");    
 | 
						|
#endif
 | 
						|
	cinfo->skbs[cinfo->in_idx++] = skb;	/* add to buffer list */
 | 
						|
	if (cinfo->in_idx >= HYSDN_MAX_CAPI_SKB)
 | 
						|
		cinfo->in_idx = 0;	/* wrap around */
 | 
						|
	cinfo->sk_count++;		/* adjust counter */
 | 
						|
	if (cinfo->sk_count >= HYSDN_MAX_CAPI_SKB) {
 | 
						|
		/* inform upper layers we're full */
 | 
						|
		printk(KERN_ERR "HYSDN Card%d: CAPI-buffer overrun!\n",
 | 
						|
		       card->myid);	
 | 
						|
		capi_ctr_suspend_output(ctrl);
 | 
						|
	}
 | 
						|
	cinfo->tx_skb = skb;
 | 
						|
	spin_unlock_irq(&cinfo->lock);
 | 
						|
	schedule_work(&card->irq_queue);
 | 
						|
}
 | 
						|
 | 
						|
/***********************************************************
 | 
						|
hycapi_register_internal
 | 
						|
 | 
						|
Send down the CAPI_REGISTER-Command to the controller.
 | 
						|
This functions will also be used if the adapter has been rebooted to
 | 
						|
re-register any applications in the private list.
 | 
						|
 | 
						|
************************************************************/
 | 
						|
 | 
						|
static void 
 | 
						|
hycapi_register_internal(struct capi_ctr *ctrl, __u16 appl,
 | 
						|
			 capi_register_params *rp)
 | 
						|
{
 | 
						|
	char ExtFeatureDefaults[] = "49  /0/0/0/0,*/1,*/2,*/3,*/4,*/5,*/6,*/7,*/8,*/9,*";
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	hysdn_card *card = cinfo->card;
 | 
						|
	struct sk_buff *skb;
 | 
						|
	__u16 len;
 | 
						|
	__u8 _command = 0xa0, _subcommand = 0x80;
 | 
						|
	__u16 MessageNumber = 0x0000;
 | 
						|
	__u16 MessageBufferSize = 0;
 | 
						|
	int slen = strlen(ExtFeatureDefaults);
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_register_appl\n"); 
 | 
						|
#endif
 | 
						|
	MessageBufferSize = rp->level3cnt * rp->datablkcnt * rp->datablklen; 
 | 
						|
 | 
						|
	len = CAPI_MSG_BASELEN + 8 + slen + 1;
 | 
						|
	if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 | 
						|
		printk(KERN_ERR "HYSDN card%d: memory squeeze in hycapi_register_appl\n",
 | 
						|
		       card->myid);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &len, sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &appl, sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u8)), &_command, sizeof(_command));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u8)), &_subcommand, sizeof(_subcommand));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &MessageNumber, sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &MessageBufferSize, sizeof(__u16)); 
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &(rp->level3cnt), sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &(rp->datablkcnt), sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &(rp->datablklen), sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,slen), ExtFeatureDefaults, slen);
 | 
						|
	hycapi_applications[appl-1].ctrl_mask |= (1 << (ctrl->cnr-1));    
 | 
						|
	hycapi_send_message(ctrl, skb);    
 | 
						|
}
 | 
						|
 | 
						|
/************************************************************
 | 
						|
hycapi_restart_internal
 | 
						|
 | 
						|
After an adapter has been rebootet, re-register all applications and
 | 
						|
send a LISTEN_REQ (if there has been such a thing )
 | 
						|
 | 
						|
*************************************************************/
 | 
						|
 | 
						|
static void hycapi_restart_internal(struct capi_ctr *ctrl)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	struct sk_buff *skb;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_WARNING "HYSDN: hycapi_restart_internal");
 | 
						|
#endif
 | 
						|
	for(i=0; i<CAPI_MAXAPPL; i++) {
 | 
						|
		if(_hycapi_appCheck(i+1, ctrl->cnr) == 1) {
 | 
						|
			hycapi_register_internal(ctrl, i+1, 
 | 
						|
						 &hycapi_applications[i].rp);
 | 
						|
			if(hycapi_applications[i].listen_req[ctrl->cnr-1]) {
 | 
						|
				skb = skb_copy(hycapi_applications[i].listen_req[ctrl->cnr-1], GFP_ATOMIC);
 | 
						|
				hycapi_sendmsg_internal(ctrl, skb);
 | 
						|
			}
 | 
						|
		}
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
/*************************************************************
 | 
						|
Register an application.
 | 
						|
Error-checking is done for CAPI-compliance.
 | 
						|
 | 
						|
The application is recorded in the internal list.
 | 
						|
*************************************************************/
 | 
						|
 | 
						|
static void
 | 
						|
hycapi_register_appl(struct capi_ctr *ctrl, __u16 appl, 
 | 
						|
		     capi_register_params *rp)
 | 
						|
{
 | 
						|
	int MaxLogicalConnections = 0, MaxBDataBlocks = 0, MaxBDataLen = 0;
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	hysdn_card *card = cinfo->card;
 | 
						|
	int chk = _hycapi_appCheck(appl, ctrl->cnr);
 | 
						|
	if(chk < 0) {
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	if(chk == 1) {
 | 
						|
		printk(KERN_INFO "HYSDN: apl %d already registered\n", appl);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	MaxBDataBlocks = rp->datablkcnt > CAPI_MAXDATAWINDOW ? CAPI_MAXDATAWINDOW : rp->datablkcnt;
 | 
						|
	rp->datablkcnt = MaxBDataBlocks;
 | 
						|
	MaxBDataLen = rp->datablklen < 1024 ? 1024 : rp->datablklen ;
 | 
						|
	rp->datablklen = MaxBDataLen;
 | 
						|
	
 | 
						|
	MaxLogicalConnections = rp->level3cnt;
 | 
						|
	if (MaxLogicalConnections < 0) {
 | 
						|
		MaxLogicalConnections = card->bchans * -MaxLogicalConnections; 
 | 
						|
	}
 | 
						|
	if (MaxLogicalConnections == 0) {
 | 
						|
		MaxLogicalConnections = card->bchans;
 | 
						|
	}
 | 
						|
	
 | 
						|
	rp->level3cnt = MaxLogicalConnections;
 | 
						|
	memcpy(&hycapi_applications[appl-1].rp, 
 | 
						|
	       rp, sizeof(capi_register_params));
 | 
						|
}
 | 
						|
 | 
						|
/*********************************************************************
 | 
						|
 | 
						|
hycapi_release_internal
 | 
						|
 | 
						|
Send down a CAPI_RELEASE to the controller.
 | 
						|
*********************************************************************/
 | 
						|
 | 
						|
static void hycapi_release_internal(struct capi_ctr *ctrl, __u16 appl)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	hysdn_card *card = cinfo->card;
 | 
						|
	struct sk_buff *skb;
 | 
						|
	__u16 len;
 | 
						|
	__u8 _command = 0xa1, _subcommand = 0x80;
 | 
						|
	__u16 MessageNumber = 0x0000;
 | 
						|
 | 
						|
	capilib_release_appl(&cinfo->ncci_head, appl);
 | 
						|
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_release_appl\n");
 | 
						|
#endif
 | 
						|
	len = CAPI_MSG_BASELEN;
 | 
						|
	if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 | 
						|
		printk(KERN_ERR "HYSDN card%d: memory squeeze in hycapi_register_appl\n",
 | 
						|
		       card->myid);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &len, sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &appl, sizeof(__u16));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u8)), &_command, sizeof(_command));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u8)), &_subcommand, sizeof(_subcommand));
 | 
						|
	memcpy(skb_put(skb,sizeof(__u16)), &MessageNumber, sizeof(__u16));    
 | 
						|
	hycapi_send_message(ctrl, skb);    
 | 
						|
	hycapi_applications[appl-1].ctrl_mask &= ~(1 << (ctrl->cnr-1));    
 | 
						|
}
 | 
						|
 | 
						|
/******************************************************************
 | 
						|
hycapi_release_appl
 | 
						|
 | 
						|
Release the application from the internal list an remove it's 
 | 
						|
registration at controller-level
 | 
						|
******************************************************************/
 | 
						|
 | 
						|
static void
 | 
						|
hycapi_release_appl(struct capi_ctr *ctrl, __u16 appl)
 | 
						|
{
 | 
						|
	int chk;
 | 
						|
 | 
						|
	chk = _hycapi_appCheck(appl, ctrl->cnr);
 | 
						|
	if(chk<0) {
 | 
						|
		printk(KERN_ERR "HYCAPI: Releasing invalid appl %d on controller %d\n", appl, ctrl->cnr);
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	if(hycapi_applications[appl-1].listen_req[ctrl->cnr-1]) {
 | 
						|
		kfree_skb(hycapi_applications[appl-1].listen_req[ctrl->cnr-1]);
 | 
						|
		hycapi_applications[appl-1].listen_req[ctrl->cnr-1] = NULL;
 | 
						|
	}
 | 
						|
	if(chk == 1)
 | 
						|
	{
 | 
						|
		hycapi_release_internal(ctrl, appl);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**************************************************************
 | 
						|
Kill a single controller.
 | 
						|
**************************************************************/
 | 
						|
 | 
						|
int hycapi_capi_release(hysdn_card *card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = card->hyctrlinfo;
 | 
						|
	struct capi_ctr *ctrl;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_capi_release\n");
 | 
						|
#endif
 | 
						|
	if(cinfo) {
 | 
						|
		ctrl = &cinfo->capi_ctrl;
 | 
						|
		hycapi_remove_ctr(ctrl);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/**************************************************************
 | 
						|
hycapi_capi_stop
 | 
						|
 | 
						|
Stop CAPI-Output on a card. (e.g. during reboot)
 | 
						|
***************************************************************/
 | 
						|
 | 
						|
int hycapi_capi_stop(hysdn_card *card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = card->hyctrlinfo;
 | 
						|
	struct capi_ctr *ctrl;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_capi_stop\n");
 | 
						|
#endif
 | 
						|
	if(cinfo) {
 | 
						|
		ctrl = &cinfo->capi_ctrl;
 | 
						|
/*		ctrl->suspend_output(ctrl); */
 | 
						|
		capi_ctr_down(ctrl);
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/***************************************************************
 | 
						|
hycapi_send_message
 | 
						|
 | 
						|
Send a message to the controller.
 | 
						|
 | 
						|
Messages are parsed for their Command/Subcommand-type, and appropriate
 | 
						|
action's are performed.
 | 
						|
 | 
						|
Note that we have to muck around with a 64Bit-DATA_REQ as there are
 | 
						|
firmware-releases that do not check the MsgLen-Indication!
 | 
						|
 | 
						|
***************************************************************/
 | 
						|
 | 
						|
static u16 hycapi_send_message(struct capi_ctr *ctrl, struct sk_buff *skb)
 | 
						|
{
 | 
						|
	__u16 appl_id;
 | 
						|
	int _len, _len2;
 | 
						|
	__u8 msghead[64];
 | 
						|
	hycapictrl_info *cinfo = ctrl->driverdata;
 | 
						|
	u16 retval = CAPI_NOERROR;
 | 
						|
 | 
						|
	appl_id = CAPIMSG_APPID(skb->data);
 | 
						|
	switch(_hycapi_appCheck(appl_id, ctrl->cnr))
 | 
						|
	{
 | 
						|
		case 0:
 | 
						|
/*			printk(KERN_INFO "Need to register\n"); */
 | 
						|
			hycapi_register_internal(ctrl, 
 | 
						|
						 appl_id,
 | 
						|
						 &(hycapi_applications[appl_id-1].rp));
 | 
						|
			break;
 | 
						|
		case 1:
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			printk(KERN_ERR "HYCAPI: Controller mixup!\n");
 | 
						|
			retval = CAPI_ILLAPPNR;
 | 
						|
			goto out;
 | 
						|
	}
 | 
						|
	switch(CAPIMSG_CMD(skb->data)) {		
 | 
						|
		case CAPI_DISCONNECT_B3_RESP:
 | 
						|
			capilib_free_ncci(&cinfo->ncci_head, appl_id, 
 | 
						|
					  CAPIMSG_NCCI(skb->data));
 | 
						|
			break;
 | 
						|
		case CAPI_DATA_B3_REQ:
 | 
						|
			_len = CAPIMSG_LEN(skb->data);
 | 
						|
			if (_len > 22) {
 | 
						|
				_len2 = _len - 22;
 | 
						|
				skb_copy_from_linear_data(skb, msghead, 22);
 | 
						|
				skb_copy_to_linear_data_offset(skb, _len2,
 | 
						|
							       msghead, 22);
 | 
						|
				skb_pull(skb, _len2);
 | 
						|
				CAPIMSG_SETLEN(skb->data, 22);
 | 
						|
				retval = capilib_data_b3_req(&cinfo->ncci_head,
 | 
						|
							     CAPIMSG_APPID(skb->data),
 | 
						|
							     CAPIMSG_NCCI(skb->data),
 | 
						|
							     CAPIMSG_MSGID(skb->data));
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case CAPI_LISTEN_REQ:
 | 
						|
			if(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1])
 | 
						|
			{
 | 
						|
				kfree_skb(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1]);
 | 
						|
				hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1] = NULL;
 | 
						|
			}
 | 
						|
			if (!(hycapi_applications[appl_id-1].listen_req[ctrl->cnr-1] = skb_copy(skb, GFP_ATOMIC))) 
 | 
						|
			{
 | 
						|
				printk(KERN_ERR "HYSDN: memory squeeze in private_listen\n");
 | 
						|
			} 
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			break;
 | 
						|
	}
 | 
						|
 out:
 | 
						|
	if (retval == CAPI_NOERROR)
 | 
						|
		hycapi_sendmsg_internal(ctrl, skb);
 | 
						|
	else 
 | 
						|
		dev_kfree_skb_any(skb);
 | 
						|
 | 
						|
	return retval;
 | 
						|
}
 | 
						|
 | 
						|
/*********************************************************************
 | 
						|
hycapi_read_proc
 | 
						|
 | 
						|
Informations provided in the /proc/capi-entries.
 | 
						|
 | 
						|
*********************************************************************/
 | 
						|
 | 
						|
static int hycapi_read_proc(char *page, char **start, off_t off,
 | 
						|
			    int count, int *eof, struct capi_ctr *ctrl)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
	hysdn_card *card = cinfo->card;
 | 
						|
	int len = 0;
 | 
						|
	char *s;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_read_proc\n");    
 | 
						|
#endif
 | 
						|
	len += sprintf(page+len, "%-16s %s\n", "name", cinfo->cardname);
 | 
						|
	len += sprintf(page+len, "%-16s 0x%x\n", "io", card->iobase);
 | 
						|
	len += sprintf(page+len, "%-16s %d\n", "irq", card->irq);
 | 
						|
    
 | 
						|
	switch (card->brdtype) {
 | 
						|
		case BD_PCCARD:  s = "HYSDN Hycard"; break;
 | 
						|
		case BD_ERGO: s = "HYSDN Ergo2"; break;
 | 
						|
		case BD_METRO: s = "HYSDN Metro4"; break;
 | 
						|
		case BD_CHAMP2: s = "HYSDN Champ2";	break;
 | 
						|
		case BD_PLEXUS: s = "HYSDN Plexus30"; break;
 | 
						|
		default: s = "???"; break;
 | 
						|
	}
 | 
						|
	len += sprintf(page+len, "%-16s %s\n", "type", s);
 | 
						|
	if ((s = cinfo->version[VER_DRIVER]) != NULL)
 | 
						|
		len += sprintf(page+len, "%-16s %s\n", "ver_driver", s);
 | 
						|
	if ((s = cinfo->version[VER_CARDTYPE]) != NULL)
 | 
						|
		len += sprintf(page+len, "%-16s %s\n", "ver_cardtype", s);
 | 
						|
	if ((s = cinfo->version[VER_SERIAL]) != NULL)
 | 
						|
		len += sprintf(page+len, "%-16s %s\n", "ver_serial", s);
 | 
						|
    
 | 
						|
	len += sprintf(page+len, "%-16s %s\n", "cardname", cinfo->cardname);
 | 
						|
    
 | 
						|
	if (off+count >= len)
 | 
						|
		*eof = 1;
 | 
						|
	if (len < off)
 | 
						|
		return 0;
 | 
						|
	*start = page + off;
 | 
						|
	return ((count < len-off) ? count : len-off);
 | 
						|
}
 | 
						|
 | 
						|
/**************************************************************
 | 
						|
hycapi_load_firmware
 | 
						|
 | 
						|
This does NOT load any firmware, but the callback somehow is needed
 | 
						|
on capi-interface registration.
 | 
						|
 | 
						|
**************************************************************/
 | 
						|
 | 
						|
static int hycapi_load_firmware(struct capi_ctr *ctrl, capiloaddata *data)
 | 
						|
{
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_load_firmware\n");    
 | 
						|
#endif
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
static char *hycapi_procinfo(struct capi_ctr *ctrl)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = (hycapictrl_info *)(ctrl->driverdata);
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_proc_info\n");    
 | 
						|
#endif
 | 
						|
	if (!cinfo)
 | 
						|
		return "";
 | 
						|
	sprintf(cinfo->infobuf, "%s %s 0x%x %d %s",
 | 
						|
		cinfo->cardname[0] ? cinfo->cardname : "-",
 | 
						|
		cinfo->version[VER_DRIVER] ? cinfo->version[VER_DRIVER] : "-",
 | 
						|
		cinfo->card ? cinfo->card->iobase : 0x0,
 | 
						|
		cinfo->card ? cinfo->card->irq : 0,
 | 
						|
		hycapi_revision
 | 
						|
		);
 | 
						|
	return cinfo->infobuf;
 | 
						|
}
 | 
						|
 | 
						|
/******************************************************************
 | 
						|
hycapi_rx_capipkt
 | 
						|
 | 
						|
Receive a capi-message.
 | 
						|
 | 
						|
All B3_DATA_IND are converted to 64K-extension compatible format.
 | 
						|
New nccis are created if necessary.
 | 
						|
*******************************************************************/
 | 
						|
 | 
						|
void
 | 
						|
hycapi_rx_capipkt(hysdn_card * card, unsigned char *buf, unsigned short len)
 | 
						|
{
 | 
						|
	struct sk_buff *skb;
 | 
						|
	hycapictrl_info *cinfo = card->hyctrlinfo;
 | 
						|
	struct capi_ctr *ctrl;
 | 
						|
	__u16 ApplId;
 | 
						|
	__u16 MsgLen, info;
 | 
						|
	__u16 len2, CapiCmd;
 | 
						|
	__u32 CP64[2] = {0,0};
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_rx_capipkt\n");    
 | 
						|
#endif
 | 
						|
	if(!cinfo) {
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	ctrl = &cinfo->capi_ctrl;
 | 
						|
	if(len < CAPI_MSG_BASELEN) {
 | 
						|
		printk(KERN_ERR "HYSDN Card%d: invalid CAPI-message, length %d!\n",
 | 
						|
		       card->myid, len);
 | 
						|
		return;
 | 
						|
	}	
 | 
						|
	MsgLen = CAPIMSG_LEN(buf);
 | 
						|
	ApplId = CAPIMSG_APPID(buf);
 | 
						|
	CapiCmd = CAPIMSG_CMD(buf);
 | 
						|
	
 | 
						|
	if((CapiCmd == CAPI_DATA_B3_IND) && (MsgLen < 30)) {
 | 
						|
		len2 = len + (30 - MsgLen);
 | 
						|
		if (!(skb = alloc_skb(len2, GFP_ATOMIC))) {
 | 
						|
			printk(KERN_ERR "HYSDN Card%d: incoming packet dropped\n",
 | 
						|
			       card->myid);
 | 
						|
			return;
 | 
						|
		}
 | 
						|
		memcpy(skb_put(skb, MsgLen), buf, MsgLen);
 | 
						|
		memcpy(skb_put(skb, 2*sizeof(__u32)), CP64, 2* sizeof(__u32));
 | 
						|
		memcpy(skb_put(skb, len - MsgLen), buf + MsgLen,
 | 
						|
		       len - MsgLen);
 | 
						|
		CAPIMSG_SETLEN(skb->data, 30);
 | 
						|
	} else {
 | 
						|
		if (!(skb = alloc_skb(len, GFP_ATOMIC))) {
 | 
						|
			printk(KERN_ERR "HYSDN Card%d: incoming packet dropped\n",
 | 
						|
			       card->myid);
 | 
						|
			return;
 | 
						|
		}
 | 
						|
		memcpy(skb_put(skb, len), buf, len);
 | 
						|
	}
 | 
						|
	switch(CAPIMSG_CMD(skb->data)) 
 | 
						|
	{
 | 
						|
		case CAPI_CONNECT_B3_CONF:
 | 
						|
/* Check info-field for error-indication: */
 | 
						|
			info = CAPIMSG_U16(skb->data, 12);
 | 
						|
			switch(info)
 | 
						|
			{
 | 
						|
				case 0:
 | 
						|
					capilib_new_ncci(&cinfo->ncci_head, ApplId, CAPIMSG_NCCI(skb->data), 
 | 
						|
							 hycapi_applications[ApplId-1].rp.datablkcnt); 
 | 
						|
					
 | 
						|
					break;
 | 
						|
				case 0x0001:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: NCPI not supported by current "
 | 
						|
					       "protocol. NCPI ignored.\n", card->myid);
 | 
						|
					break;
 | 
						|
				case 0x2001:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: Message not supported in"
 | 
						|
					       " current state\n", card->myid);
 | 
						|
					break;
 | 
						|
				case 0x2002:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: invalid PLCI\n", card->myid);
 | 
						|
					break;		
 | 
						|
				case 0x2004:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: out of NCCI\n", card->myid);
 | 
						|
					break;				
 | 
						|
				case 0x3008:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: NCPI not supported\n", 
 | 
						|
					       card->myid);
 | 
						|
					break;	
 | 
						|
				default:
 | 
						|
					printk(KERN_ERR "HYSDN Card%d: Info in CONNECT_B3_CONF: %d\n", 
 | 
						|
					       card->myid, info);
 | 
						|
					break;			
 | 
						|
			}
 | 
						|
			break;
 | 
						|
		case CAPI_CONNECT_B3_IND:
 | 
						|
			capilib_new_ncci(&cinfo->ncci_head, ApplId, 
 | 
						|
					 CAPIMSG_NCCI(skb->data), 
 | 
						|
					 hycapi_applications[ApplId-1].rp.datablkcnt);
 | 
						|
			break;
 | 
						|
	        case CAPI_DATA_B3_CONF:
 | 
						|
			capilib_data_b3_conf(&cinfo->ncci_head, ApplId,
 | 
						|
					     CAPIMSG_NCCI(skb->data),
 | 
						|
					     CAPIMSG_MSGID(skb->data));
 | 
						|
			break;
 | 
						|
		default:
 | 
						|
			break;
 | 
						|
	}
 | 
						|
	capi_ctr_handle_message(ctrl, ApplId, skb);
 | 
						|
}
 | 
						|
 | 
						|
/******************************************************************
 | 
						|
hycapi_tx_capiack
 | 
						|
 | 
						|
Internally acknowledge a msg sent. This will remove the msg from the
 | 
						|
internal queue.
 | 
						|
 | 
						|
*******************************************************************/
 | 
						|
 | 
						|
void hycapi_tx_capiack(hysdn_card * card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = card->hyctrlinfo;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_tx_capiack\n");    
 | 
						|
#endif
 | 
						|
	if(!cinfo) {
 | 
						|
		return;
 | 
						|
	}
 | 
						|
	spin_lock_irq(&cinfo->lock);
 | 
						|
	kfree_skb(cinfo->skbs[cinfo->out_idx]);		/* free skb */
 | 
						|
	cinfo->skbs[cinfo->out_idx++] = NULL;
 | 
						|
	if (cinfo->out_idx >= HYSDN_MAX_CAPI_SKB)
 | 
						|
		cinfo->out_idx = 0;	/* wrap around */
 | 
						|
 | 
						|
	if (cinfo->sk_count-- == HYSDN_MAX_CAPI_SKB)	/* dec usage count */
 | 
						|
		capi_ctr_resume_output(&cinfo->capi_ctrl);
 | 
						|
	spin_unlock_irq(&cinfo->lock);
 | 
						|
}
 | 
						|
 | 
						|
/***************************************************************
 | 
						|
hycapi_tx_capiget(hysdn_card *card)
 | 
						|
 | 
						|
This is called when polling for messages to SEND.
 | 
						|
 | 
						|
****************************************************************/
 | 
						|
 | 
						|
struct sk_buff *
 | 
						|
hycapi_tx_capiget(hysdn_card *card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = card->hyctrlinfo;
 | 
						|
	if(!cinfo) {
 | 
						|
		return (struct sk_buff *)NULL;
 | 
						|
	}
 | 
						|
	if (!cinfo->sk_count)
 | 
						|
		return (struct sk_buff *)NULL;	/* nothing available */
 | 
						|
 | 
						|
	return (cinfo->skbs[cinfo->out_idx]);		/* next packet to send */
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
/**********************************************************
 | 
						|
int hycapi_init()
 | 
						|
 | 
						|
attach the capi-driver to the kernel-capi.
 | 
						|
 | 
						|
***********************************************************/
 | 
						|
 | 
						|
int hycapi_init(void)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	for(i=0;i<CAPI_MAXAPPL;i++) {
 | 
						|
		memset(&(hycapi_applications[i]), 0, sizeof(hycapi_appl));
 | 
						|
	}
 | 
						|
	return(0);
 | 
						|
}
 | 
						|
 | 
						|
/**************************************************************
 | 
						|
hycapi_cleanup(void)
 | 
						|
 | 
						|
detach the capi-driver to the kernel-capi. Actually this should
 | 
						|
free some more ressources. Do that later.
 | 
						|
**************************************************************/
 | 
						|
 | 
						|
void 
 | 
						|
hycapi_cleanup(void)
 | 
						|
{
 | 
						|
}
 | 
						|
 | 
						|
/********************************************************************
 | 
						|
hycapi_capi_create(hysdn_card *card)
 | 
						|
 | 
						|
Attach the card with its capi-ctrl.
 | 
						|
*********************************************************************/
 | 
						|
 | 
						|
static void hycapi_fill_profile(hysdn_card *card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = NULL;
 | 
						|
	struct capi_ctr *ctrl = NULL;
 | 
						|
	cinfo = card->hyctrlinfo;
 | 
						|
	if(!cinfo) return;
 | 
						|
	ctrl = &cinfo->capi_ctrl;
 | 
						|
	strcpy(ctrl->manu, "Hypercope");	
 | 
						|
	ctrl->version.majorversion = 2;
 | 
						|
	ctrl->version.minorversion = 0;
 | 
						|
	ctrl->version.majormanuversion = 3;
 | 
						|
	ctrl->version.minormanuversion = 2;
 | 
						|
	ctrl->profile.ncontroller = card->myid;
 | 
						|
	ctrl->profile.nbchannel = card->bchans;
 | 
						|
	ctrl->profile.goptions = GLOBAL_OPTION_INTERNAL_CONTROLLER |
 | 
						|
		GLOBAL_OPTION_B_CHANNEL_OPERATION;
 | 
						|
	ctrl->profile.support1 =  B1_PROT_64KBIT_HDLC |
 | 
						|
		(card->faxchans ? B1_PROT_T30 : 0) |
 | 
						|
		B1_PROT_64KBIT_TRANSPARENT;
 | 
						|
	ctrl->profile.support2 = B2_PROT_ISO7776 |
 | 
						|
		(card->faxchans ? B2_PROT_T30 : 0) |
 | 
						|
		B2_PROT_TRANSPARENT;
 | 
						|
	ctrl->profile.support3 = B3_PROT_TRANSPARENT |
 | 
						|
		B3_PROT_T90NL |
 | 
						|
		(card->faxchans ? B3_PROT_T30 : 0) |
 | 
						|
		(card->faxchans ? B3_PROT_T30EXT : 0) |
 | 
						|
		B3_PROT_ISO8208;
 | 
						|
}	
 | 
						|
 | 
						|
int 
 | 
						|
hycapi_capi_create(hysdn_card *card)
 | 
						|
{
 | 
						|
	hycapictrl_info *cinfo = NULL;
 | 
						|
	struct capi_ctr *ctrl = NULL;
 | 
						|
	int retval;
 | 
						|
#ifdef HYCAPI_PRINTFNAMES
 | 
						|
	printk(KERN_NOTICE "hycapi_capi_create\n");        
 | 
						|
#endif
 | 
						|
	if((hycapi_enable & (1 << card->myid)) == 0) {
 | 
						|
		return 1;
 | 
						|
	}
 | 
						|
	if (!card->hyctrlinfo) {
 | 
						|
		cinfo = kzalloc(sizeof(hycapictrl_info), GFP_ATOMIC);
 | 
						|
		if (!cinfo) {
 | 
						|
			printk(KERN_WARNING "HYSDN: no memory for capi-ctrl.\n");
 | 
						|
			return -ENOMEM;
 | 
						|
		}
 | 
						|
		card->hyctrlinfo = cinfo;
 | 
						|
		cinfo->card = card;
 | 
						|
		spin_lock_init(&cinfo->lock);
 | 
						|
		INIT_LIST_HEAD(&cinfo->ncci_head);
 | 
						|
 | 
						|
		switch (card->brdtype) {
 | 
						|
			case BD_PCCARD:  strcpy(cinfo->cardname,"HYSDN Hycard"); break;
 | 
						|
			case BD_ERGO: strcpy(cinfo->cardname,"HYSDN Ergo2"); break;
 | 
						|
			case BD_METRO: strcpy(cinfo->cardname,"HYSDN Metro4"); break;
 | 
						|
			case BD_CHAMP2: strcpy(cinfo->cardname,"HYSDN Champ2"); break;
 | 
						|
			case BD_PLEXUS: strcpy(cinfo->cardname,"HYSDN Plexus30"); break;
 | 
						|
			default: strcpy(cinfo->cardname,"HYSDN ???"); break;
 | 
						|
		}
 | 
						|
 | 
						|
		ctrl = &cinfo->capi_ctrl;
 | 
						|
		ctrl->driver_name   = "hycapi";
 | 
						|
		ctrl->driverdata    = cinfo;
 | 
						|
		ctrl->register_appl = hycapi_register_appl;
 | 
						|
		ctrl->release_appl  = hycapi_release_appl;
 | 
						|
		ctrl->send_message  = hycapi_send_message;
 | 
						|
		ctrl->load_firmware = hycapi_load_firmware;
 | 
						|
		ctrl->reset_ctr     = hycapi_reset_ctr;
 | 
						|
		ctrl->procinfo      = hycapi_procinfo;
 | 
						|
		ctrl->ctr_read_proc = hycapi_read_proc;
 | 
						|
		strcpy(ctrl->name, cinfo->cardname);
 | 
						|
		ctrl->owner = THIS_MODULE;
 | 
						|
 | 
						|
		retval = attach_capi_ctr(ctrl);
 | 
						|
		if (retval) {
 | 
						|
			printk(KERN_ERR "hycapi: attach controller failed.\n");
 | 
						|
			return -EBUSY;
 | 
						|
		}
 | 
						|
		/* fill in the blanks: */
 | 
						|
		hycapi_fill_profile(card);
 | 
						|
		capi_ctr_ready(ctrl);
 | 
						|
	} else {
 | 
						|
		/* resume output on stopped ctrl */
 | 
						|
		ctrl = &card->hyctrlinfo->capi_ctrl;
 | 
						|
		hycapi_fill_profile(card);
 | 
						|
		capi_ctr_ready(ctrl);
 | 
						|
		hycapi_restart_internal(ctrl); 
 | 
						|
/*		ctrl->resume_output(ctrl); */
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 |