1 /* Copyright (C) 2007-2008 One Stop Systems
2 * Copyright (C) 2003-2006 SBE, Inc.
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
15 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
17 #include <linux/types.h>
18 #include <linux/netdevice.h>
19 #include <linux/hdlc.h>
20 #include <linux/if_arp.h>
21 #include <linux/init.h>
22 #include <asm/uaccess.h>
23 #include <linux/rtnetlink.h>
24 #include <linux/skbuff.h>
25 #include "pmcc4_sysdep.h"
26 #include "sbecom_inline_linux.h"
29 #include "pmcc4_ioctls.h"
30 #include "pmcc4_private.h"
33 /*****************************************************************************************
34 * Error out early if we have compiler trouble.
36 * (This section is included from the kernel's init/main.c as a friendly
37 * spiderman recommendation...)
39 * Versions of gcc older than that listed below may actually compile and link
40 * okay, but the end product can have subtle run time bugs. To avoid associated
41 * bogus bug reports, we flatly refuse to compile with a gcc that is known to be
42 * too old from the very beginning.
44 #if (__GNUC__ < 3) || (__GNUC__ == 3 && __GNUC_MINOR__ < 2)
45 #error Sorry, your GCC is too old. It builds incorrect kernels.
48 #if __GNUC__ == 4 && __GNUC_MINOR__ == 1 && __GNUC_PATCHLEVEL__ == 0
49 #warning gcc-4.1.0 is known to miscompile the kernel. A different compiler version is recommended.
52 /*****************************************************************************************/
54 #ifdef SBE_INCLUDE_SYMBOLS
60 #define CHANNAME "hdlc"
62 /*******************************************************************/
63 /* forward references */
64 status_t c4_chan_work_init (mpi_t *, mch_t *);
65 void musycc_wq_chan_restart (void *);
66 status_t __init c4_init (ci_t *, u_char *, u_char *);
67 status_t __init c4_init2 (ci_t *);
68 ci_t *__init c4_new (void *);
69 int __init c4hw_attach_all (void);
70 void __init hdw_sn_get (hdw_info_t *, int);
72 #ifdef CONFIG_SBE_PMCC4_NCOMM
73 irqreturn_t c4_ebus_intr_th_handler (void *);
76 int c4_frame_rw (ci_t *, struct sbecom_port_param *);
77 status_t c4_get_port (ci_t *, int);
78 int c4_loop_port (ci_t *, int, u_int8_t);
79 int c4_musycc_rw (ci_t *, struct c4_musycc_param *);
80 int c4_new_chan (ci_t *, int, int, void *);
81 status_t c4_set_port (ci_t *, int);
82 int c4_pld_rw (ci_t *, struct sbecom_port_param *);
83 void cleanup_devs (void);
84 void cleanup_ioremap (void);
85 status_t musycc_chan_down (ci_t *, int);
86 irqreturn_t musycc_intr_th_handler (void *);
87 int musycc_start_xmit (ci_t *, int, void *);
89 extern char pmcc4_OSSI_release[];
91 extern struct s_hdw_info hdw_info[];
93 #if defined(CONFIG_SBE_HDLC_V7) || defined(CONFIG_SBE_WAN256T3_HDLC_V7) || \
94 defined(CONFIG_SBE_HDLC_V7_MODULE) || defined(CONFIG_SBE_WAN256T3_HDLC_V7_MODULE)
101 #define V7(x) (x ## _v7)
102 extern int hdlc_netif_rx_v7 (hdlc_device *, struct sk_buff *);
103 extern int register_hdlc_device_v7 (hdlc_device *);
104 extern int unregister_hdlc_device_v7 (hdlc_device *);
110 int error_flag; /* module load error reporting */
111 int log_level = LOG_ERROR;
112 int log_level_default = LOG_ERROR;
113 module_param(log_level, int, 0444);
115 int max_mru = MUSYCC_MRU;
116 int max_mru_default = MUSYCC_MRU;
117 module_param(max_mru, int, 0444);
119 int max_mtu = MUSYCC_MTU;
120 int max_mtu_default = MUSYCC_MTU;
121 module_param(max_mtu, int, 0444);
123 int max_txdesc_used = MUSYCC_TXDESC_MIN;
124 int max_txdesc_default = MUSYCC_TXDESC_MIN;
125 module_param(max_txdesc_used, int, 0444);
127 int max_rxdesc_used = MUSYCC_RXDESC_MIN;
128 int max_rxdesc_default = MUSYCC_RXDESC_MIN;
129 module_param(max_rxdesc_used, int, 0444);
131 /****************************************************************************/
132 /****************************************************************************/
133 /****************************************************************************/
136 getuserbychan (int channum)
140 ch = c4_find_chan (channum);
141 return ch ? ch->user : 0;
145 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
146 #define DEV_TO_PRIV(dev) ( * (struct c4_priv **) ((hdlc_device*)(dev)+1))
150 get_hdlc_name (hdlc_device * hdlc)
152 struct c4_priv *priv = hdlc->priv;
153 struct net_device *dev = getuserbychan (priv->channum);
169 /***************************************************************************/
170 #if LINUX_VERSION_CODE > KERNEL_VERSION(2,5,41)
171 #include <linux/workqueue.h>
174 * One workqueue (wq) per port (since musycc allows simultaneous group
175 * commands), with individual data for each channel:
177 * mpi_t -> struct workqueue_struct *wq_port; (dynamically allocated using
178 * create_workqueue())
180 * With work structure (work) statically allocated for each channel:
182 * mch_t -> struct work_struct ch_work; (statically allocated using ???)
188 * Called by the start transmit routine when a channel TX_ENABLE is to be
189 * issued. This queues the transmission start request among other channels
190 * within a port's group.
193 c4_wk_chan_restart (mch_t * ch)
197 #ifdef RLD_RESTART_DEBUG
198 printk (">> c4_wk_chan_restart: queueing Port %d Chan %d, mch_t @ %p\n", pi->portnum, ch->channum, ch);
201 /* create new entry w/in workqueue for this channel and let'er rip */
203 /** queue_work (struct workqueue_struct *queue,
204 ** struct work_struct *work);
206 queue_work (pi->wq_port, &ch->ch_work);
210 c4_wk_chan_init (mpi_t * pi, mch_t * ch)
213 * this will be used to restart a stopped channel
216 /** INIT_WORK (struct work_struct *work,
217 ** void (*function)(void *),
220 INIT_WORK(&ch->ch_work, (void *)musycc_wq_chan_restart);
221 return 0; /* success */
225 c4_wq_port_init (mpi_t * pi)
228 char name[16], *np; /* NOTE: name of the queue limited by system
229 * to 10 characters */
232 return 0; /* already initialized */
235 memset (name, 0, 16);
236 sprintf (np, "%s%d", pi->up->devname, pi->portnum); /* IE pmcc4-01) */
238 #ifdef RLD_RESTART_DEBUG
239 printk (">> c4_wq_port_init: creating workqueue <%s> for Port %d.\n", name, pi->portnum); /* RLD DEBUG */
241 if (!(pi->wq_port = create_singlethread_workqueue (name)))
243 return 0; /* success */
247 c4_wq_port_cleanup (mpi_t * pi)
250 * PORT POINT: cannot call this if WQ is statically allocated w/in
251 * structure since it calls kfree(wq);
255 destroy_workqueue (pi->wq_port); /* this also calls
256 * flush_workqueue() */
262 /***************************************************************************/
265 c4_linux_interrupt (int irq, void *dev_instance)
267 struct net_device *ndev = dev_instance;
269 return musycc_intr_th_handler(netdev_priv(ndev));
273 #ifdef CONFIG_SBE_PMCC4_NCOMM
275 c4_ebus_interrupt (int irq, void *dev_instance)
277 struct net_device *ndev = dev_instance;
279 return c4_ebus_intr_th_handler(netdev_priv(ndev));
285 void_open (struct net_device * ndev)
287 printk ("%s: trying to open master device !\n", ndev->name);
292 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
293 #if !defined(GENERIC_HDLC_VERSION) || (GENERIC_HDLC_VERSION < 4)
295 /** Linux 2.4.18-19 **/
297 chan_open (hdlc_device * hdlc)
301 if ((ret = c4_chan_up (DEV_TO_PRIV (hdlc)->ci, DEV_TO_PRIV (hdlc)->channum)))
304 netif_start_queue (hdlc_to_dev (hdlc));
305 return 0; /* no error = success */
310 /** Linux 2.4.20 and higher **/
312 chan_open (struct net_device * ndev)
314 hdlc_device *hdlc = dev_to_hdlc (ndev);
317 hdlc->proto = IF_PROTO_HDLC;
318 if ((ret = hdlc_open (hdlc)))
320 printk ("%s: hdlc_open failure, err %d.\n", THIS_MODULE->name, ret);
323 if ((ret = c4_chan_up (DEV_TO_PRIV (hdlc)->ci, DEV_TO_PRIV (hdlc)->channum)))
326 netif_start_queue (hdlc_to_dev (hdlc));
327 return 0; /* no error = success */
335 chan_open (struct net_device * ndev)
337 hdlc_device *hdlc = dev_to_hdlc (ndev);
338 const struct c4_priv *priv = hdlc->priv;
341 if ((ret = hdlc_open (ndev)))
343 printk ("%s: hdlc_open failure, err %d.\n", THIS_MODULE->name, ret);
346 if ((ret = c4_chan_up (priv->ci, priv->channum)))
348 try_module_get (THIS_MODULE);
349 netif_start_queue (ndev);
350 return 0; /* no error = success */
355 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
356 #if !defined(GENERIC_HDLC_VERSION) || (GENERIC_HDLC_VERSION < 4)
358 /** Linux 2.4.18-19 **/
360 chan_close (hdlc_device * hdlc)
362 netif_stop_queue (hdlc_to_dev (hdlc));
363 musycc_chan_down ((ci_t *) 0, DEV_TO_PRIV (hdlc)->channum);
368 /** Linux 2.4.20 and higher **/
370 chan_close (struct net_device * ndev)
372 hdlc_device *hdlc = dev_to_hdlc (ndev);
374 netif_stop_queue (hdlc_to_dev (hdlc));
375 musycc_chan_down ((ci_t *) 0, DEV_TO_PRIV (hdlc)->channum);
386 chan_close (struct net_device * ndev)
388 hdlc_device *hdlc = dev_to_hdlc (ndev);
389 const struct c4_priv *priv = hdlc->priv;
391 netif_stop_queue (ndev);
392 musycc_chan_down ((ci_t *) 0, priv->channum);
394 module_put (THIS_MODULE);
400 #if !defined(GENERIC_HDLC_VERSION) || (GENERIC_HDLC_VERSION < 4)
402 /** Linux 2.4.18-19 **/
404 chan_ioctl (hdlc_device * hdlc, struct ifreq * ifr, int cmd)
406 if (cmd == HDLCSCLOCK)
408 ifr->ifr_ifru.ifru_ivalue = LINE_DEFAULT;
416 #if !defined(GENERIC_HDLC_VERSION) || (GENERIC_HDLC_VERSION < 4)
418 chan_dev_ioctl (struct net_device * hdlc, struct ifreq * ifr, int cmd)
420 if (cmd == HDLCSCLOCK)
422 ifr->ifr_ifru.ifru_ivalue = LINE_DEFAULT;
429 chan_dev_ioctl (struct net_device * dev, struct ifreq * ifr, int cmd)
431 return hdlc_ioctl (dev, ifr, cmd);
436 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
437 chan_attach_noop (hdlc_device * hdlc, unsigned short foo_1, unsigned short foo_2)
439 chan_attach_noop (struct net_device * ndev, unsigned short foo_1, unsigned short foo_2)
442 return 0; /* our driver has nothing to do here, show's
448 STATIC struct net_device_stats *
449 chan_get_stats (struct net_device * ndev)
452 struct net_device_stats *nstats;
453 struct sbecom_chan_stats *stats;
456 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
457 channum = DEV_TO_PRIV (ndev)->channum;
460 struct c4_priv *priv;
462 priv = (struct c4_priv *) dev_to_hdlc (ndev)->priv;
463 channum = priv->channum;
467 ch = c4_find_chan (channum);
471 nstats = &ndev->stats;
474 memset (nstats, 0, sizeof (struct net_device_stats));
475 nstats->rx_packets = stats->rx_packets;
476 nstats->tx_packets = stats->tx_packets;
477 nstats->rx_bytes = stats->rx_bytes;
478 nstats->tx_bytes = stats->tx_bytes;
479 nstats->rx_errors = stats->rx_length_errors +
480 stats->rx_over_errors +
481 stats->rx_crc_errors +
482 stats->rx_frame_errors +
483 stats->rx_fifo_errors +
484 stats->rx_missed_errors;
485 nstats->tx_errors = stats->tx_dropped +
486 stats->tx_aborted_errors +
487 stats->tx_fifo_errors;
488 nstats->rx_dropped = stats->rx_dropped;
489 nstats->tx_dropped = stats->tx_dropped;
491 nstats->rx_length_errors = stats->rx_length_errors;
492 nstats->rx_over_errors = stats->rx_over_errors;
493 nstats->rx_crc_errors = stats->rx_crc_errors;
494 nstats->rx_frame_errors = stats->rx_frame_errors;
495 nstats->rx_fifo_errors = stats->rx_fifo_errors;
496 nstats->rx_missed_errors = stats->rx_missed_errors;
498 nstats->tx_aborted_errors = stats->tx_aborted_errors;
499 nstats->tx_fifo_errors = stats->tx_fifo_errors;
506 get_ci_by_dev (struct net_device * ndev)
508 return (ci_t *)(netdev_priv(ndev));
512 #if !defined(GENERIC_HDLC_VERSION) || (GENERIC_HDLC_VERSION < 4)
514 c4_linux_xmit (hdlc_device * hdlc, struct sk_buff * skb)
518 rval = musycc_start_xmit (DEV_TO_PRIV (hdlc)->ci, DEV_TO_PRIV (hdlc)->channum, skb);
523 c4_linux_xmit (struct sk_buff * skb, struct net_device * ndev)
525 const struct c4_priv *priv;
528 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
529 priv = DEV_TO_PRIV (ndev);
531 hdlc_device *hdlc = dev_to_hdlc (ndev);
536 rval = musycc_start_xmit (priv->ci, priv->channum, skb);
539 #endif /* GENERIC_HDLC_VERSION */
541 static const struct net_device_ops chan_ops = {
542 .ndo_open = chan_open,
543 .ndo_stop = chan_close,
544 .ndo_start_xmit = c4_linux_xmit,
545 .ndo_do_ioctl = chan_dev_ioctl,
546 .ndo_get_stats = chan_get_stats,
549 STATIC struct net_device *
550 create_chan (struct net_device * ndev, ci_t * ci,
551 struct sbecom_chan_param * cp)
554 struct net_device *dev;
558 if (c4_find_chan (cp->channum))
559 return 0; /* channel already exists */
562 struct c4_priv *priv;
564 /* allocate then fill in private data structure */
565 priv = OS_kmalloc (sizeof (struct c4_priv));
568 pr_warning("%s: no memory for net_device !\n", ci->devname);
571 dev = alloc_hdlcdev (priv);
574 pr_warning("%s: no memory for hdlc_device !\n", ci->devname);
579 priv->channum = cp->channum;
582 hdlc = dev_to_hdlc (dev);
584 dev->base_addr = 0; /* not I/O mapped */
585 dev->irq = ndev->irq;
586 dev->type = ARPHRD_RAWHDLC;
587 *dev->name = 0; /* default ifconfig name = "hdlc" */
589 hi = (hdw_info_t *) ci->hdw_info;
590 if (hi->mfg_info_sts == EEPROM_OK)
594 case PROM_FORMAT_TYPE1:
595 memcpy (dev->dev_addr, (FLD_TYPE1 *) (hi->mfg_info.pft1.Serial), 6);
597 case PROM_FORMAT_TYPE2:
598 memcpy (dev->dev_addr, (FLD_TYPE2 *) (hi->mfg_info.pft2.Serial), 6);
601 memset (dev->dev_addr, 0, 6);
606 memset (dev->dev_addr, 0, 6);
609 hdlc->xmit = c4_linux_xmit;
611 dev->netdev_ops = &chan_ops;
613 * The native hdlc stack calls this 'attach' routine during
614 * hdlc_raw_ioctl(), passing parameters for line encoding and parity.
615 * Since hdlc_raw_ioctl() stack does not interrogate whether an 'attach'
616 * routine is actually registered or not, we supply a dummy routine which
617 * does nothing (since encoding and parity are setup for our driver via a
618 * special configuration application).
621 hdlc->attach = chan_attach_noop;
623 rtnl_unlock (); /* needed due to Ioctl calling sequence */
624 ret = register_hdlc_device (dev);
625 /* NOTE: <stats> setting must occur AFTER registration in order to "take" */
626 dev->tx_queue_len = MAX_DEFAULT_IFQLEN;
628 rtnl_lock (); /* needed due to Ioctl calling sequence */
631 if (log_level >= LOG_WARN)
632 printk ("%s: create_chan[%d] registration error = %d.\n",
633 ci->devname, cp->channum, ret);
634 free_netdev (dev); /* cleanup */
635 return 0; /* failed to register */
641 /* the idea here is to get port information and pass it back (using pointer) */
643 do_get_port (struct net_device * ndev, void *data)
646 ci_t *ci; /* ci stands for card information */
647 struct sbecom_port_param pp;/* copy data to kernel land */
649 if (copy_from_user (&pp, data, sizeof (struct sbecom_port_param)))
651 if (pp.portnum >= MUSYCC_NPORTS)
653 ci = get_ci_by_dev (ndev);
655 return -EINVAL; /* get card info */
657 ret = mkret (c4_get_port (ci, pp.portnum));
660 if (copy_to_user (data, &ci->port[pp.portnum].p,
661 sizeof (struct sbecom_port_param)))
666 /* this function copys the user data and then calls the real action function */
668 do_set_port (struct net_device * ndev, void *data)
670 ci_t *ci; /* ci stands for card information */
671 struct sbecom_port_param pp;/* copy data to kernel land */
673 if (copy_from_user (&pp, data, sizeof (struct sbecom_port_param)))
675 if (pp.portnum >= MUSYCC_NPORTS)
677 ci = get_ci_by_dev (ndev);
679 return -EINVAL; /* get card info */
681 if (pp.portnum >= ci->max_port) /* sanity check */
684 memcpy (&ci->port[pp.portnum].p, &pp, sizeof (struct sbecom_port_param));
685 return mkret (c4_set_port (ci, pp.portnum));
688 /* work the port loopback mode as per directed */
690 do_port_loop (struct net_device * ndev, void *data)
692 struct sbecom_port_param pp;
695 if (copy_from_user (&pp, data, sizeof (struct sbecom_port_param)))
697 ci = get_ci_by_dev (ndev);
700 return mkret (c4_loop_port (ci, pp.portnum, pp.port_mode));
703 /* set the specified register with the given value / or just read it */
705 do_framer_rw (struct net_device * ndev, void *data)
707 struct sbecom_port_param pp;
711 if (copy_from_user (&pp, data, sizeof (struct sbecom_port_param)))
713 ci = get_ci_by_dev (ndev);
716 ret = mkret (c4_frame_rw (ci, &pp));
719 if (copy_to_user (data, &pp, sizeof (struct sbecom_port_param)))
724 /* set the specified register with the given value / or just read it */
726 do_pld_rw (struct net_device * ndev, void *data)
728 struct sbecom_port_param pp;
732 if (copy_from_user (&pp, data, sizeof (struct sbecom_port_param)))
734 ci = get_ci_by_dev (ndev);
737 ret = mkret (c4_pld_rw (ci, &pp));
740 if (copy_to_user (data, &pp, sizeof (struct sbecom_port_param)))
745 /* set the specified register with the given value / or just read it */
747 do_musycc_rw (struct net_device * ndev, void *data)
749 struct c4_musycc_param mp;
753 if (copy_from_user (&mp, data, sizeof (struct c4_musycc_param)))
755 ci = get_ci_by_dev (ndev);
758 ret = mkret (c4_musycc_rw (ci, &mp));
761 if (copy_to_user (data, &mp, sizeof (struct c4_musycc_param)))
767 do_get_chan (struct net_device * ndev, void *data)
769 struct sbecom_chan_param cp;
772 if (copy_from_user (&cp, data,
773 sizeof (struct sbecom_chan_param)))
776 if ((ret = mkret (c4_get_chan (cp.channum, &cp))))
779 if (copy_to_user (data, &cp, sizeof (struct sbecom_chan_param)))
785 do_set_chan (struct net_device * ndev, void *data)
787 struct sbecom_chan_param cp;
791 if (copy_from_user (&cp, data, sizeof (struct sbecom_chan_param)))
793 ci = get_ci_by_dev (ndev);
796 switch (ret = mkret (c4_set_chan (cp.channum, &cp)))
806 do_create_chan (struct net_device * ndev, void *data)
809 struct net_device *dev;
810 struct sbecom_chan_param cp;
813 if (copy_from_user (&cp, data, sizeof (struct sbecom_chan_param)))
815 ci = get_ci_by_dev (ndev);
818 dev = create_chan (ndev, ci, &cp);
821 ret = mkret (c4_new_chan (ci, cp.port, cp.channum, dev));
824 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
825 rtnl_unlock (); /* needed due to Ioctl calling sequence */
826 V7 (unregister_hdlc_device) (dev_to_hdlc (dev));
827 rtnl_lock (); /* needed due to Ioctl calling sequence */
828 OS_kfree (DEV_TO_PRIV (dev));
831 rtnl_unlock (); /* needed due to Ioctl calling sequence */
832 unregister_hdlc_device (dev);
833 rtnl_lock (); /* needed due to Ioctl calling sequence */
841 do_get_chan_stats (struct net_device * ndev, void *data)
843 struct c4_chan_stats_wrap ccs;
846 if (copy_from_user (&ccs, data,
847 sizeof (struct c4_chan_stats_wrap)))
849 switch (ret = mkret (c4_get_chan_stats (ccs.channum, &ccs.stats)))
856 if (copy_to_user (data, &ccs,
857 sizeof (struct c4_chan_stats_wrap)))
862 do_set_loglevel (struct net_device * ndev, void *data)
864 unsigned int log_level;
866 if (copy_from_user (&log_level, data, sizeof (int)))
868 sbecom_set_loglevel (log_level);
873 do_deluser (struct net_device * ndev, int lockit)
875 if (ndev->flags & IFF_UP)
881 const struct c4_priv *priv;
884 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
885 priv = DEV_TO_PRIV (ndev);
887 priv = (struct c4_priv *) dev_to_hdlc (ndev)->priv;
890 channum = priv->channum;
892 ch = c4_find_chan (channum);
895 ch->user = 0; /* will be freed, below */
898 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
900 rtnl_unlock (); /* needed if Ioctl calling sequence */
901 V7 (unregister_hdlc_device) (dev_to_hdlc (ndev));
903 rtnl_lock (); /* needed if Ioctl calling sequence */
904 OS_kfree (DEV_TO_PRIV (ndev));
908 rtnl_unlock (); /* needed if Ioctl calling sequence */
909 unregister_hdlc_device (ndev);
911 rtnl_lock (); /* needed if Ioctl calling sequence */
918 do_del_chan (struct net_device * musycc_dev, void *data)
920 struct sbecom_chan_param cp;
921 char buf[sizeof (CHANNAME) + 3];
922 struct net_device *dev;
925 if (copy_from_user (&cp, data,
926 sizeof (struct sbecom_chan_param)))
928 sprintf (buf, CHANNAME "%d", cp.channum);
929 if (!(dev = dev_get_by_name (&init_net, buf)))
932 ret = do_deluser (dev, 1);
935 return c4_del_chan (cp.channum);
937 int c4_reset_board (void *);
940 do_reset (struct net_device * musycc_dev, void *data)
942 const struct c4_priv *priv;
945 for (i = 0; i < 128; i++)
947 struct net_device *ndev;
948 char buf[sizeof (CHANNAME) + 3];
950 sprintf (buf, CHANNAME "%d", i);
951 if (!(ndev = dev_get_by_name(&init_net, buf)))
953 priv = dev_to_hdlc (ndev)->priv;
955 if ((unsigned long) (priv->ci) ==
956 (unsigned long) (netdev_priv(musycc_dev)))
958 ndev->flags &= ~IFF_UP;
960 netif_stop_queue (ndev);
961 do_deluser (ndev, 1);
969 do_reset_chan_stats (struct net_device * musycc_dev, void *data)
971 struct sbecom_chan_param cp;
973 if (copy_from_user (&cp, data,
974 sizeof (struct sbecom_chan_param)))
976 return mkret (c4_del_chan_stats (cp.channum));
980 c4_ioctl (struct net_device * ndev, struct ifreq * ifr, int cmd)
992 struct sbe_brd_info bip;
993 struct sbe_drv_info dip;
994 struct sbe_iid_info iip;
995 struct sbe_brd_addr bap;
996 struct sbecom_chan_stats stats;
997 struct sbecom_chan_param param;
998 struct temux_card_stats cards;
999 struct sbecom_card_param cardp;
1000 struct sbecom_framer_param frp;
1005 if (!capable (CAP_SYS_ADMIN))
1007 if (cmd != SIOCDEVPRIVATE + 15)
1009 if (!(ci = get_ci_by_dev (ndev)))
1011 if (ci->state != C_RUNNING)
1013 if (copy_from_user (&iocmd, ifr->ifr_data, sizeof (iocmd)))
1016 if (copy_from_user (&len, ifr->ifr_data + sizeof (iocmd), sizeof (len)))
1021 printk ("c4_ioctl: iocmd %x, dir %x type %x nr %x iolen %d.\n", iocmd,
1022 _IOC_DIR (iocmd), _IOC_TYPE (iocmd), _IOC_NR (iocmd),
1025 iolen = _IOC_SIZE (iocmd);
1026 data = ifr->ifr_data + sizeof (iocmd);
1027 if (copy_from_user (&arg, data, iolen))
1033 case SBE_IOC_PORT_GET:
1034 //printk (">> SBE_IOC_PORT_GET Ioctl...\n");
1035 ret = do_get_port (ndev, data);
1037 case SBE_IOC_PORT_SET:
1038 //printk (">> SBE_IOC_PORT_SET Ioctl...\n");
1039 ret = do_set_port (ndev, data);
1041 case SBE_IOC_CHAN_GET:
1042 //printk (">> SBE_IOC_CHAN_GET Ioctl...\n");
1043 ret = do_get_chan (ndev, data);
1045 case SBE_IOC_CHAN_SET:
1046 //printk (">> SBE_IOC_CHAN_SET Ioctl...\n");
1047 ret = do_set_chan (ndev, data);
1050 //printk (">> C4_DEL_CHAN Ioctl...\n");
1051 ret = do_del_chan (ndev, data);
1053 case SBE_IOC_CHAN_NEW:
1054 ret = do_create_chan (ndev, data);
1056 case SBE_IOC_CHAN_GET_STAT:
1057 ret = do_get_chan_stats (ndev, data);
1059 case SBE_IOC_LOGLEVEL:
1060 ret = do_set_loglevel (ndev, data);
1062 case SBE_IOC_RESET_DEV:
1063 ret = do_reset (ndev, data);
1065 case SBE_IOC_CHAN_DEL_STAT:
1066 ret = do_reset_chan_stats (ndev, data);
1069 ret = do_port_loop (ndev, data);
1072 ret = do_framer_rw (ndev, data);
1075 ret = do_musycc_rw (ndev, data);
1078 ret = do_pld_rw (ndev, data);
1080 case SBE_IOC_IID_GET:
1081 ret = (iolen == sizeof (struct sbe_iid_info)) ? c4_get_iidinfo (ci, &arg.u.iip) : -EFAULT;
1082 if (ret == 0) /* no error, copy data */
1083 if (copy_to_user (data, &arg, iolen))
1087 //printk (">> c4_ioctl: EINVAL - unknown iocmd <%x>\n", iocmd);
1094 static const struct net_device_ops c4_ops = {
1095 .ndo_open = void_open,
1096 .ndo_start_xmit = c4_linux_xmit,
1097 .ndo_do_ioctl = c4_ioctl,
1100 static void c4_setup(struct net_device *dev)
1102 dev->type = ARPHRD_VOID;
1103 dev->netdev_ops = &c4_ops;
1106 struct net_device *__init
1107 c4_add_dev (hdw_info_t * hi, int brdno, unsigned long f0, unsigned long f1,
1110 struct net_device *ndev;
1113 ndev = alloc_netdev(sizeof(ci_t), SBE_IFACETMPL, c4_setup);
1116 pr_warning("%s: no memory for struct net_device !\n", hi->devname);
1117 error_flag = ENOMEM;
1120 ci = (ci_t *)(netdev_priv(ndev));
1124 ci->state = C_INIT; /* mark as hardware not available */
1127 ci->brdno = ci->next ? ci->next->brdno + 1 : 0;
1130 CI = ci; /* DEBUG, only board 0 usage */
1132 strcpy (ci->devname, hi->devname);
1133 ci->release = &pmcc4_OSSI_release[0];
1136 #if defined(SBE_ISR_TASKLET)
1137 tasklet_init (&ci->ci_musycc_isr_tasklet,
1138 (void (*) (unsigned long)) musycc_intr_bh_tasklet,
1139 (unsigned long) ci);
1141 if (atomic_read (&ci->ci_musycc_isr_tasklet.count) == 0)
1142 tasklet_disable_nosync (&ci->ci_musycc_isr_tasklet);
1143 #elif defined(SBE_ISR_IMMEDIATE)
1144 ci->ci_musycc_isr_tq.routine = (void *) (unsigned long) musycc_intr_bh_tasklet;
1145 ci->ci_musycc_isr_tq.data = ci;
1149 if (register_netdev (ndev) ||
1150 (c4_init (ci, (u_char *) f0, (u_char *) f1) != SBE_DRVR_SUCCESS))
1152 OS_kfree (netdev_priv(ndev));
1154 error_flag = ENODEV;
1157 /*************************************************************
1158 * int request_irq(unsigned int irq,
1159 * void (*handler)(int, void *, struct pt_regs *),
1160 * unsigned long flags, const char *dev_name, void *dev_id);
1162 * irq -> The interrupt number that is being requested.
1163 * handler -> Pointer to handling function being installed.
1164 * flags -> A bit mask of options related to interrupt management.
1165 * dev_name -> String used in /proc/interrupts to show owner of interrupt.
1166 * dev_id -> Pointer (for shared interrupt lines) to point to its own
1167 * private data area (to identify which device is interrupting).
1169 * extern void free_irq(unsigned int irq, void *dev_id);
1170 **************************************************************/
1172 if (request_irq (irq0, &c4_linux_interrupt,
1173 #if defined(SBE_ISR_TASKLET)
1174 IRQF_DISABLED | IRQF_SHARED,
1175 #elif defined(SBE_ISR_IMMEDIATE)
1176 IRQF_DISABLED | IRQF_SHARED,
1177 #elif defined(SBE_ISR_INLINE)
1182 pr_warning("%s: MUSYCC could not get irq: %d\n", ndev->name, irq0);
1183 unregister_netdev (ndev);
1184 OS_kfree (netdev_priv(ndev));
1189 #ifdef CONFIG_SBE_PMCC4_NCOMM
1190 if (request_irq (irq1, &c4_ebus_interrupt, IRQF_SHARED, ndev->name, ndev))
1192 pr_warning("%s: EBUS could not get irq: %d\n", hi->devname, irq1);
1193 unregister_netdev (ndev);
1194 free_irq (irq0, ndev);
1195 OS_kfree (netdev_priv(ndev));
1202 /* setup board identification information */
1207 hdw_sn_get (hi, brdno); /* also sets PROM format type (promfmt)
1208 * for later usage */
1210 switch (hi->promfmt)
1212 case PROM_FORMAT_TYPE1:
1213 memcpy (ndev->dev_addr, (FLD_TYPE1 *) (hi->mfg_info.pft1.Serial), 6);
1214 memcpy (&tmp, (FLD_TYPE1 *) (hi->mfg_info.pft1.Id), 4); /* unaligned data
1216 ci->brd_id = cpu_to_be32 (tmp);
1218 case PROM_FORMAT_TYPE2:
1219 memcpy (ndev->dev_addr, (FLD_TYPE2 *) (hi->mfg_info.pft2.Serial), 6);
1220 memcpy (&tmp, (FLD_TYPE2 *) (hi->mfg_info.pft2.Id), 4); /* unaligned data
1222 ci->brd_id = cpu_to_be32 (tmp);
1226 memset (ndev->dev_addr, 0, 6);
1231 sbeid_set_hdwbid (ci); /* requires bid to be preset */
1233 sbeid_set_bdtype (ci); /* requires hdw_bid to be preset */
1238 #ifdef CONFIG_PROC_FS
1239 sbecom_proc_brd_init (ci);
1241 #if defined(SBE_ISR_TASKLET)
1242 tasklet_enable (&ci->ci_musycc_isr_tasklet);
1246 if ((error_flag = c4_init2 (ci)) != SBE_DRVR_SUCCESS)
1248 #ifdef CONFIG_PROC_FS
1249 sbecom_proc_brd_cleanup (ci);
1251 unregister_netdev (ndev);
1252 free_irq (irq1, ndev);
1253 free_irq (irq0, ndev);
1254 OS_kfree (netdev_priv(ndev));
1256 return 0; /* failure, error_flag is set */
1266 pr_warning("%s\n", pmcc4_OSSI_release);
1267 if ((rtn = c4hw_attach_all ()))
1268 return -rtn; /* installation failure - see system log */
1270 /* housekeeping notifications */
1271 if (log_level != log_level_default)
1272 pr_info("NOTE: driver parameter <log_level> changed from default %d to %d.\n",
1273 log_level_default, log_level);
1274 if (max_mru != max_mru_default)
1275 pr_info("NOTE: driver parameter <max_mru> changed from default %d to %d.\n",
1276 max_mru_default, max_mru);
1277 if (max_mtu != max_mtu_default)
1278 pr_info("NOTE: driver parameter <max_mtu> changed from default %d to %d.\n",
1279 max_mtu_default, max_mtu);
1280 if (max_rxdesc_used != max_rxdesc_default)
1282 if (max_rxdesc_used > 2000)
1283 max_rxdesc_used = 2000; /* out-of-bounds reset */
1284 pr_info("NOTE: driver parameter <max_rxdesc_used> changed from default %d to %d.\n",
1285 max_rxdesc_default, max_rxdesc_used);
1287 if (max_txdesc_used != max_txdesc_default)
1289 if (max_txdesc_used > 1000)
1290 max_txdesc_used = 1000; /* out-of-bounds reset */
1291 pr_info("NOTE: driver parameter <max_txdesc_used> changed from default %d to %d.\n",
1292 max_txdesc_default, max_txdesc_used);
1294 return 0; /* installation success */
1299 * find any still allocated hdlc registrations and unregister via call to
1308 struct net_device *ndev;
1311 for (i = 0, hi = hdw_info; i < MAX_BOARDS; i++, hi++)
1313 if (hi->ndev) /* a board has been attached */
1315 ci = (ci_t *)(netdev_priv(hi->ndev));
1316 for (j = 0; j < ci->max_port; j++)
1317 for (k = 0; k < MUSYCC_NCHANS; k++)
1318 if ((ndev = ci->port[j].chan[k]->user))
1320 do_deluser (ndev, 0);
1328 c4_mod_remove (void)
1330 cleanup_hdlc (); /* delete any missed channels */
1334 pr_info("SBE - driver removed.\n");
1337 module_init (c4_mod_init);
1338 module_exit (c4_mod_remove);
1340 #ifndef SBE_INCLUDE_SYMBOLS
1341 #ifndef CONFIG_SBE_WANC24_NCOMM
1342 #if LINUX_VERSION_CODE < KERNEL_VERSION(2,5,0)
1348 MODULE_AUTHOR ("SBE Technical Services <support@sbei.com>");
1349 MODULE_DESCRIPTION ("wanPCI-CxT1E1 Generic HDLC WAN Driver module");
1350 #ifdef MODULE_LICENSE
1351 MODULE_LICENSE ("GPL");
1354 /*** End-of-File ***/