Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 1 | /* |
| 2 | * CAIF Interface registration. |
| 3 | * Copyright (C) ST-Ericsson AB 2010 |
| 4 | * Author: Sjur Brendeland/sjur.brandeland@stericsson.com |
| 5 | * License terms: GNU General Public License (GPL) version 2 |
| 6 | * |
| 7 | * Borrowed heavily from file: pn_dev.c. Thanks to |
| 8 | * Remi Denis-Courmont <remi.denis-courmont@nokia.com> |
| 9 | * and Sakari Ailus <sakari.ailus@nokia.com> |
| 10 | */ |
| 11 | |
Joe Perches | b31fa5b | 2010-09-05 21:31:11 +0000 | [diff] [blame] | 12 | #define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__ |
| 13 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 14 | #include <linux/version.h> |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 15 | #include <linux/kernel.h> |
| 16 | #include <linux/if_arp.h> |
| 17 | #include <linux/net.h> |
| 18 | #include <linux/netdevice.h> |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 19 | #include <linux/mutex.h> |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 20 | #include <net/netns/generic.h> |
| 21 | #include <net/net_namespace.h> |
| 22 | #include <net/pkt_sched.h> |
| 23 | #include <net/caif/caif_device.h> |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 24 | #include <net/caif/caif_layer.h> |
| 25 | #include <net/caif/cfpkt.h> |
| 26 | #include <net/caif/cfcnfg.h> |
| 27 | |
| 28 | MODULE_LICENSE("GPL"); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 29 | |
| 30 | /* Used for local tracking of the CAIF net devices */ |
| 31 | struct caif_device_entry { |
| 32 | struct cflayer layer; |
| 33 | struct list_head list; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 34 | struct net_device *netdev; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 35 | int __percpu *pcpu_refcnt; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 36 | }; |
| 37 | |
| 38 | struct caif_device_entry_list { |
| 39 | struct list_head list; |
| 40 | /* Protects simulanous deletes in list */ |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 41 | struct mutex lock; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 42 | }; |
| 43 | |
| 44 | struct caif_net { |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 45 | struct cfcnfg *cfg; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 46 | struct caif_device_entry_list caifdevs; |
| 47 | }; |
| 48 | |
| 49 | static int caif_net_id; |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 50 | |
| 51 | struct cfcnfg *get_cfcnfg(struct net *net) |
| 52 | { |
| 53 | struct caif_net *caifn; |
| 54 | BUG_ON(!net); |
| 55 | caifn = net_generic(net, caif_net_id); |
| 56 | BUG_ON(!caifn); |
| 57 | return caifn->cfg; |
| 58 | } |
| 59 | EXPORT_SYMBOL(get_cfcnfg); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 60 | |
| 61 | static struct caif_device_entry_list *caif_device_list(struct net *net) |
| 62 | { |
| 63 | struct caif_net *caifn; |
| 64 | BUG_ON(!net); |
| 65 | caifn = net_generic(net, caif_net_id); |
| 66 | BUG_ON(!caifn); |
| 67 | return &caifn->caifdevs; |
| 68 | } |
| 69 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 70 | static void caifd_put(struct caif_device_entry *e) |
| 71 | { |
| 72 | irqsafe_cpu_dec(*e->pcpu_refcnt); |
| 73 | } |
| 74 | |
| 75 | static void caifd_hold(struct caif_device_entry *e) |
| 76 | { |
| 77 | irqsafe_cpu_inc(*e->pcpu_refcnt); |
| 78 | } |
| 79 | |
| 80 | static int caifd_refcnt_read(struct caif_device_entry *e) |
| 81 | { |
| 82 | int i, refcnt = 0; |
| 83 | for_each_possible_cpu(i) |
| 84 | refcnt += *per_cpu_ptr(e->pcpu_refcnt, i); |
| 85 | return refcnt; |
| 86 | } |
| 87 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 88 | /* Allocate new CAIF device. */ |
| 89 | static struct caif_device_entry *caif_device_alloc(struct net_device *dev) |
| 90 | { |
| 91 | struct caif_device_entry_list *caifdevs; |
| 92 | struct caif_device_entry *caifd; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 93 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 94 | caifdevs = caif_device_list(dev_net(dev)); |
| 95 | BUG_ON(!caifdevs); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 96 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 97 | caifd = kzalloc(sizeof(*caifd), GFP_ATOMIC); |
| 98 | if (!caifd) |
| 99 | return NULL; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 100 | caifd->pcpu_refcnt = alloc_percpu(int); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 101 | caifd->netdev = dev; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 102 | dev_hold(dev); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 103 | return caifd; |
| 104 | } |
| 105 | |
| 106 | static struct caif_device_entry *caif_get(struct net_device *dev) |
| 107 | { |
| 108 | struct caif_device_entry_list *caifdevs = |
| 109 | caif_device_list(dev_net(dev)); |
| 110 | struct caif_device_entry *caifd; |
| 111 | BUG_ON(!caifdevs); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 112 | list_for_each_entry_rcu(caifd, &caifdevs->list, list) { |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 113 | if (caifd->netdev == dev) |
| 114 | return caifd; |
| 115 | } |
| 116 | return NULL; |
| 117 | } |
| 118 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 119 | static int transmit(struct cflayer *layer, struct cfpkt *pkt) |
| 120 | { |
| 121 | struct caif_device_entry *caifd = |
| 122 | container_of(layer, struct caif_device_entry, layer); |
Sjur Brændeland | 4dd820c | 2011-04-11 10:43:51 +0000 | [diff] [blame] | 123 | struct sk_buff *skb; |
| 124 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 125 | skb = cfpkt_tonative(pkt); |
| 126 | skb->dev = caifd->netdev; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 127 | |
Sjur Brændeland | 4dd820c | 2011-04-11 10:43:51 +0000 | [diff] [blame] | 128 | dev_queue_xmit(skb); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 129 | |
| 130 | return 0; |
| 131 | } |
| 132 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 133 | /* |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 134 | * Stuff received packets into the CAIF stack. |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 135 | * On error, returns non-zero and releases the skb. |
| 136 | */ |
| 137 | static int receive(struct sk_buff *skb, struct net_device *dev, |
| 138 | struct packet_type *pkttype, struct net_device *orig_dev) |
| 139 | { |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 140 | struct cfpkt *pkt; |
| 141 | struct caif_device_entry *caifd; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 142 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 143 | pkt = cfpkt_fromnative(CAIF_DIR_IN, skb); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 144 | |
| 145 | rcu_read_lock(); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 146 | caifd = caif_get(dev); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 147 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 148 | if (!caifd || !caifd->layer.up || !caifd->layer.up->receive || |
| 149 | !netif_oper_up(caifd->netdev)) { |
| 150 | rcu_read_unlock(); |
| 151 | kfree_skb(skb); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 152 | return NET_RX_DROP; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 153 | } |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 154 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 155 | /* Hold reference to netdevice while using CAIF stack */ |
| 156 | caifd_hold(caifd); |
| 157 | rcu_read_unlock(); |
| 158 | |
| 159 | caifd->layer.up->receive(caifd->layer.up, pkt); |
| 160 | |
| 161 | /* Release reference to stack upwards */ |
| 162 | caifd_put(caifd); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 163 | return 0; |
| 164 | } |
| 165 | |
| 166 | static struct packet_type caif_packet_type __read_mostly = { |
| 167 | .type = cpu_to_be16(ETH_P_CAIF), |
| 168 | .func = receive, |
| 169 | }; |
| 170 | |
| 171 | static void dev_flowctrl(struct net_device *dev, int on) |
| 172 | { |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 173 | struct caif_device_entry *caifd; |
| 174 | |
| 175 | rcu_read_lock(); |
| 176 | |
| 177 | caifd = caif_get(dev); |
| 178 | if (!caifd || !caifd->layer.up || !caifd->layer.up->ctrlcmd) { |
| 179 | rcu_read_unlock(); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 180 | return; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 181 | } |
| 182 | |
| 183 | caifd_hold(caifd); |
| 184 | rcu_read_unlock(); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 185 | |
| 186 | caifd->layer.up->ctrlcmd(caifd->layer.up, |
| 187 | on ? |
| 188 | _CAIF_CTRLCMD_PHYIF_FLOW_ON_IND : |
| 189 | _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND, |
| 190 | caifd->layer.id); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 191 | caifd_put(caifd); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 192 | } |
| 193 | |
| 194 | /* notify Caif of device events */ |
| 195 | static int caif_device_notify(struct notifier_block *me, unsigned long what, |
| 196 | void *arg) |
| 197 | { |
| 198 | struct net_device *dev = arg; |
| 199 | struct caif_device_entry *caifd = NULL; |
| 200 | struct caif_dev_common *caifdev; |
| 201 | enum cfcnfg_phy_preference pref; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 202 | enum cfcnfg_phy_type phy_type; |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 203 | struct cfcnfg *cfg; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 204 | struct caif_device_entry_list *caifdevs = |
| 205 | caif_device_list(dev_net(dev)); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 206 | |
| 207 | if (dev->type != ARPHRD_CAIF) |
| 208 | return 0; |
| 209 | |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 210 | cfg = get_cfcnfg(dev_net(dev)); |
| 211 | if (cfg == NULL) |
| 212 | return 0; |
| 213 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 214 | switch (what) { |
| 215 | case NETDEV_REGISTER: |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 216 | caifd = caif_device_alloc(dev); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 217 | if (!caifd) |
| 218 | return 0; |
| 219 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 220 | caifdev = netdev_priv(dev); |
| 221 | caifdev->flowctrl = dev_flowctrl; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 222 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 223 | caifd->layer.transmit = transmit; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 224 | |
| 225 | if (caifdev->use_frag) |
| 226 | phy_type = CFPHYTYPE_FRAG; |
| 227 | else |
| 228 | phy_type = CFPHYTYPE_CAIF; |
| 229 | |
| 230 | switch (caifdev->link_select) { |
| 231 | case CAIF_LINK_HIGH_BANDW: |
Sjur Braendeland | 2c48520 | 2010-04-28 08:54:40 +0000 | [diff] [blame] | 232 | pref = CFPHYPREF_HIGH_BW; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 233 | break; |
| 234 | case CAIF_LINK_LOW_LATENCY: |
Sjur Braendeland | 2c48520 | 2010-04-28 08:54:40 +0000 | [diff] [blame] | 235 | pref = CFPHYPREF_LOW_LAT; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 236 | break; |
| 237 | default: |
| 238 | pref = CFPHYPREF_HIGH_BW; |
| 239 | break; |
| 240 | } |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 241 | strncpy(caifd->layer.name, dev->name, |
| 242 | sizeof(caifd->layer.name) - 1); |
| 243 | caifd->layer.name[sizeof(caifd->layer.name) - 1] = 0; |
| 244 | |
| 245 | mutex_lock(&caifdevs->lock); |
| 246 | list_add_rcu(&caifd->list, &caifdevs->list); |
| 247 | |
Stephen Hemminger | 73d6ac6 | 2011-04-11 10:43:50 +0000 | [diff] [blame] | 248 | cfcnfg_add_phy_layer(cfg, |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 249 | phy_type, |
| 250 | dev, |
| 251 | &caifd->layer, |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 252 | pref, |
| 253 | caifdev->use_fcs, |
| 254 | caifdev->use_stx); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 255 | mutex_unlock(&caifdevs->lock); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 256 | break; |
| 257 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 258 | case NETDEV_UP: |
| 259 | rcu_read_lock(); |
| 260 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 261 | caifd = caif_get(dev); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 262 | if (caifd == NULL) { |
| 263 | rcu_read_unlock(); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 264 | break; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 265 | } |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 266 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 267 | cfcnfg_set_phy_state(cfg, &caifd->layer, true); |
| 268 | rcu_read_unlock(); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 269 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 270 | break; |
| 271 | |
| 272 | case NETDEV_DOWN: |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 273 | rcu_read_lock(); |
| 274 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 275 | caifd = caif_get(dev); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 276 | if (!caifd || !caifd->layer.up || !caifd->layer.up->ctrlcmd) { |
| 277 | rcu_read_unlock(); |
| 278 | return -EINVAL; |
| 279 | } |
| 280 | |
| 281 | cfcnfg_set_phy_state(cfg, &caifd->layer, false); |
| 282 | caifd_hold(caifd); |
| 283 | rcu_read_unlock(); |
| 284 | |
| 285 | caifd->layer.up->ctrlcmd(caifd->layer.up, |
| 286 | _CAIF_CTRLCMD_PHYIF_DOWN_IND, |
| 287 | caifd->layer.id); |
| 288 | caifd_put(caifd); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 289 | break; |
| 290 | |
| 291 | case NETDEV_UNREGISTER: |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 292 | mutex_lock(&caifdevs->lock); |
| 293 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 294 | caifd = caif_get(dev); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 295 | if (caifd == NULL) { |
| 296 | mutex_unlock(&caifdevs->lock); |
André Carvalho de Matos | f2527ec | 2010-11-01 11:52:47 +0000 | [diff] [blame] | 297 | break; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 298 | } |
| 299 | list_del_rcu(&caifd->list); |
| 300 | |
| 301 | /* |
| 302 | * NETDEV_UNREGISTER is called repeatedly until all reference |
| 303 | * counts for the net-device are released. If references to |
| 304 | * caifd is taken, simply ignore NETDEV_UNREGISTER and wait for |
| 305 | * the next call to NETDEV_UNREGISTER. |
| 306 | * |
| 307 | * If any packets are in flight down the CAIF Stack, |
| 308 | * cfcnfg_del_phy_layer will return nonzero. |
| 309 | * If no packets are in flight, the CAIF Stack associated |
| 310 | * with the net-device un-registering is freed. |
| 311 | */ |
| 312 | |
| 313 | if (caifd_refcnt_read(caifd) != 0 || |
| 314 | cfcnfg_del_phy_layer(cfg, &caifd->layer) != 0) { |
| 315 | |
| 316 | pr_info("Wait for device inuse\n"); |
| 317 | /* Enrole device if CAIF Stack is still in use */ |
| 318 | list_add_rcu(&caifd->list, &caifdevs->list); |
| 319 | mutex_unlock(&caifdevs->lock); |
| 320 | break; |
| 321 | } |
| 322 | |
| 323 | synchronize_rcu(); |
| 324 | dev_put(caifd->netdev); |
| 325 | free_percpu(caifd->pcpu_refcnt); |
| 326 | kfree(caifd); |
| 327 | |
| 328 | mutex_unlock(&caifdevs->lock); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 329 | break; |
| 330 | } |
| 331 | return 0; |
| 332 | } |
| 333 | |
| 334 | static struct notifier_block caif_device_notifier = { |
| 335 | .notifier_call = caif_device_notify, |
| 336 | .priority = 0, |
| 337 | }; |
| 338 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 339 | /* Per-namespace Caif devices handling */ |
| 340 | static int caif_init_net(struct net *net) |
| 341 | { |
| 342 | struct caif_net *caifn = net_generic(net, caif_net_id); |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 343 | BUG_ON(!caifn); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 344 | INIT_LIST_HEAD(&caifn->caifdevs.list); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 345 | mutex_init(&caifn->caifdevs.lock); |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 346 | |
| 347 | caifn->cfg = cfcnfg_create(); |
| 348 | if (!caifn->cfg) { |
| 349 | pr_warn("can't create cfcnfg\n"); |
| 350 | return -ENOMEM; |
| 351 | } |
| 352 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 353 | return 0; |
| 354 | } |
| 355 | |
| 356 | static void caif_exit_net(struct net *net) |
| 357 | { |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 358 | struct caif_device_entry *caifd, *tmp; |
| 359 | struct caif_device_entry_list *caifdevs = |
| 360 | caif_device_list(net); |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 361 | struct cfcnfg *cfg; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 362 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 363 | rtnl_lock(); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 364 | mutex_lock(&caifdevs->lock); |
| 365 | |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 366 | cfg = get_cfcnfg(net); |
| 367 | if (cfg == NULL) { |
| 368 | mutex_unlock(&caifdevs->lock); |
| 369 | return; |
| 370 | } |
| 371 | |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 372 | list_for_each_entry_safe(caifd, tmp, &caifdevs->list, list) { |
| 373 | int i = 0; |
| 374 | list_del_rcu(&caifd->list); |
| 375 | cfcnfg_set_phy_state(cfg, &caifd->layer, false); |
| 376 | |
| 377 | while (i < 10 && |
| 378 | (caifd_refcnt_read(caifd) != 0 || |
| 379 | cfcnfg_del_phy_layer(cfg, &caifd->layer) != 0)) { |
| 380 | |
| 381 | pr_info("Wait for device inuse\n"); |
| 382 | msleep(250); |
| 383 | i++; |
| 384 | } |
| 385 | synchronize_rcu(); |
| 386 | dev_put(caifd->netdev); |
| 387 | free_percpu(caifd->pcpu_refcnt); |
| 388 | kfree(caifd); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 389 | } |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 390 | cfcnfg_remove(cfg); |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 391 | |
| 392 | mutex_unlock(&caifdevs->lock); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 393 | rtnl_unlock(); |
| 394 | } |
| 395 | |
| 396 | static struct pernet_operations caif_net_ops = { |
| 397 | .init = caif_init_net, |
| 398 | .exit = caif_exit_net, |
| 399 | .id = &caif_net_id, |
| 400 | .size = sizeof(struct caif_net), |
| 401 | }; |
| 402 | |
| 403 | /* Initialize Caif devices list */ |
| 404 | static int __init caif_device_init(void) |
| 405 | { |
| 406 | int result; |
sjur.brandeland@stericsson.com | bd30ce4 | 2011-05-13 02:44:00 +0000 | [diff] [blame] | 407 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 408 | result = register_pernet_device(&caif_net_ops); |
| 409 | |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 410 | if (result) |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 411 | return result; |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 412 | |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 413 | register_netdevice_notifier(&caif_device_notifier); |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 414 | dev_add_pack(&caif_packet_type); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 415 | |
| 416 | return result; |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 417 | } |
| 418 | |
| 419 | static void __exit caif_device_exit(void) |
| 420 | { |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 421 | unregister_pernet_device(&caif_net_ops); |
| 422 | unregister_netdevice_notifier(&caif_device_notifier); |
sjur.brandeland@stericsson.com | bee925d | 2011-05-13 02:44:05 +0000 | [diff] [blame^] | 423 | dev_remove_pack(&caif_packet_type); |
Sjur Braendeland | c72dfae | 2010-03-30 13:56:25 +0000 | [diff] [blame] | 424 | } |
| 425 | |
| 426 | module_init(caif_device_init); |
| 427 | module_exit(caif_device_exit); |