void unregister_hdlc_device(hdlc_device *hdlc)
{
if (hdlc_to_dev(hdlc)->name==NULL)
return; /* device not registered */
destroy_pvc_list(hdlc);
unregister_netdevice(hdlc_to_dev(hdlc));
MOD_DEC_USE_COUNT;
}
void unregister_hdlc_device(hdlc_device *hdlc)
{
destroy_pvc_list(hdlc);
unregister_netdev(hdlc_to_dev(hdlc));
MOD_DEC_USE_COUNT;
}
static int hdlc_set_mode(hdlc_device *hdlc, int mode)
{
int result=-1; /* Default to soft modes */
if(!capable(CAP_NET_ADMIN))
return -EPERM;
if(hdlc_to_dev(hdlc)->flags & IFF_UP)
return -EBUSY;
hdlc_to_dev(hdlc)->addr_len=0;
hdlc->mode=MODE_NONE;
if (!(mode & MODE_SOFT))
switch(mode) {
case MODE_HDLC:
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, MODE_HDLC) : 0;
break;
case MODE_X25: /* By card */
case MODE_CISCO:
case MODE_PPP:
case MODE_FR_ANSI:
case MODE_FR_CCITT:
case MODE_FR_ANSI | MODE_DCE:
case MODE_FR_CCITT | MODE_DCE:
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, mode) : -ENOSYS;
break;
default:
return -EINVAL;
}
if (result) {
mode |= MODE_SOFT; /* Try "host software" protocol */
switch(mode & ~MODE_SOFT) {
case MODE_CISCO:
case MODE_PPP:
break;
case MODE_FR_ANSI:
case MODE_FR_CCITT:
case MODE_FR_ANSI | MODE_DCE:
case MODE_FR_CCITT | MODE_DCE:
hdlc_to_dev(hdlc)->addr_len=2;
*(u16*)hdlc_to_dev(hdlc)->dev_addr=htons(LMI_DLCI);
dlci_to_q922(hdlc_to_dev(hdlc)->broadcast, LMI_DLCI);
break;
default:
return -EINVAL;
}
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, MODE_HDLC) : 0;
}
if (result)
return result;
hdlc->mode=mode;
if (mode_is(hdlc, MODE_PPP))
hdlc_to_dev(hdlc)->type=ARPHRD_PPP;
if (mode_is(hdlc, MODE_X25))
hdlc_to_dev(hdlc)->type=ARPHRD_X25;
else if (mode_is(hdlc, MODE_FR))
hdlc_to_dev(hdlc)->type=ARPHRD_FRAD;
else /* Conflict - raw HDLC and Cisco */
hdlc_to_dev(hdlc)->type=ARPHRD_HDLC;
memset(&(hdlc->stats), 0, sizeof(struct net_device_stats));
destroy_pvc_list(hdlc);
return 0;
}
static int hdlc_set_mode(hdlc_device *hdlc, int mode)
{
int result = -1; /* Default to soft modes */
struct net_device *dev = hdlc_to_dev(hdlc);
if(!capable(CAP_NET_ADMIN))
return -EPERM;
if(dev->flags & IFF_UP)
return -EBUSY;
dev->addr_len = 0;
dev->hard_header = NULL;
hdlc->mode = MODE_NONE;
if (!(mode & MODE_SOFT))
switch(mode & MODE_MASK) {
case MODE_HDLC:
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, MODE_HDLC) : 0;
break;
case MODE_CISCO: /* By card */
#ifdef CONFIG_HDLC_PPP
case MODE_PPP:
#endif
#ifdef CONFIG_HDLC_X25
case MODE_X25:
#endif
case MODE_FR:
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, mode) : -ENOSYS;
break;
default:
return -EINVAL;
}
if (result) {
mode |= MODE_SOFT; /* Try "host software" protocol */
switch(mode & MODE_MASK) {
case MODE_CISCO:
dev->hard_header = cisco_hard_header;
break;
#ifdef CONFIG_HDLC_PPP
case MODE_PPP:
break;
#endif
#ifdef CONFIG_HDLC_X25
case MODE_X25:
break;
#endif
case MODE_FR:
dev->hard_header = fr_hard_header;
dev->addr_len = 2;
*(u16*)dev->dev_addr = htons(LMI_DLCI);
dlci_to_q922(dev->broadcast, LMI_DLCI);
break;
default:
return -EINVAL;
}
result = hdlc->set_mode ?
hdlc->set_mode(hdlc, MODE_HDLC) : 0;
}
if (result)
return result;
hdlc->mode = mode;
switch(mode & MODE_MASK) {
#ifdef CONFIG_HDLC_PPP
case MODE_PPP: dev->type = ARPHRD_PPP; break;
#endif
#ifdef CONFIG_HDLC_X25
case MODE_X25: dev->type = ARPHRD_X25; break;
#endif
case MODE_FR: dev->type = ARPHRD_FRAD; break;
case MODE_CISCO: dev->type = ARPHRD_CISCO; break;
default: dev->type = ARPHRD_RAWHDLC;
}
memset(&(hdlc->stats), 0, sizeof(struct net_device_stats));
destroy_pvc_list(hdlc);
return 0;
}
