Blame view
net/caif/cfcnfg.c
14.4 KB
15c9ac0c8 net-caif: add CAI... |
1 2 3 4 5 |
/* * Copyright (C) ST-Ericsson AB 2010 * Author: Sjur Brendeland/sjur.brandeland@stericsson.com * License terms: GNU General Public License (GPL) version 2 */ |
b31fa5bad net/caif: Use pr_fmt |
6 7 |
#define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__ |
15c9ac0c8 net-caif: add CAI... |
8 9 |
#include <linux/kernel.h> #include <linux/stddef.h> |
6c5799069 net-caif: using k... |
10 |
#include <linux/slab.h> |
2aa40aef9 caif: Use link la... |
11 |
#include <linux/netdevice.h> |
f36214408 caif: Use RCU and... |
12 |
#include <linux/module.h> |
15c9ac0c8 net-caif: add CAI... |
13 14 15 16 17 18 19 20 |
#include <net/caif/caif_layer.h> #include <net/caif/cfpkt.h> #include <net/caif/cfcnfg.h> #include <net/caif/cfctrl.h> #include <net/caif/cfmuxl.h> #include <net/caif/cffrml.h> #include <net/caif/cfserl.h> #include <net/caif/cfsrvl.h> |
f36214408 caif: Use RCU and... |
21 |
#include <net/caif/caif_dev.h> |
15c9ac0c8 net-caif: add CAI... |
22 23 24 25 26 27 28 |
#define container_obj(layr) container_of(layr, struct cfcnfg, layer) /* Information about CAIF physical interfaces held by Config Module in order * to manage physical interfaces */ struct cfcnfg_phyinfo { |
f36214408 caif: Use RCU and... |
29 30 |
struct list_head node; bool up; |
15c9ac0c8 net-caif: add CAI... |
31 32 33 34 35 36 37 38 |
/* Pointer to the layer below the MUX (framing layer) */ struct cflayer *frm_layer; /* Pointer to the lowest actual physical layer */ struct cflayer *phy_layer; /* Unique identifier of the physical interface */ unsigned int id; /* Preference of the physical in interface */ enum cfcnfg_phy_preference pref; |
15c9ac0c8 net-caif: add CAI... |
39 40 |
/* Information about the physical device */ struct dev_info dev_info; |
2aa40aef9 caif: Use link la... |
41 42 43 |
/* Interface index */ int ifindex; |
7c18d2205 caif: Restructure... |
44 45 |
/* Protocol head room added for CAIF link layer */ int head_room; |
2aa40aef9 caif: Use link la... |
46 47 48 |
/* Use Start of frame checksum */ bool use_fcs; |
15c9ac0c8 net-caif: add CAI... |
49 50 51 52 53 54 |
}; struct cfcnfg { struct cflayer layer; struct cflayer *ctrl; struct cflayer *mux; |
f36214408 caif: Use RCU and... |
55 56 |
struct list_head phys; struct mutex lock; |
15c9ac0c8 net-caif: add CAI... |
57 |
}; |
e539d83cc caif: Rename func... |
58 |
static void cfcnfg_linkup_rsp(struct cflayer *layer, u8 channel_id, |
15c9ac0c8 net-caif: add CAI... |
59 60 |
enum cfctrl_srv serv, u8 phyid, struct cflayer *adapt_layer); |
8d545c8f9 caif: Disconnect ... |
61 |
static void cfcnfg_linkdestroy_rsp(struct cflayer *layer, u8 channel_id); |
e539d83cc caif: Rename func... |
62 |
static void cfcnfg_reject_rsp(struct cflayer *layer, u8 channel_id, |
15c9ac0c8 net-caif: add CAI... |
63 64 65 66 67 68 69 70 |
struct cflayer *adapt_layer); static void cfctrl_resp_func(void); static void cfctrl_enum_resp(void); struct cfcnfg *cfcnfg_create(void) { struct cfcnfg *this; struct cfctrl_rsp *resp; |
f36214408 caif: Use RCU and... |
71 72 |
might_sleep(); |
15c9ac0c8 net-caif: add CAI... |
73 |
/* Initiate this layer */ |
49afa55b5 net/caif: Use kza... |
74 |
this = kzalloc(sizeof(struct cfcnfg), GFP_ATOMIC); |
7ac2ed0ce caif: Remove OOM ... |
75 |
if (!this) |
15c9ac0c8 net-caif: add CAI... |
76 |
return NULL; |
15c9ac0c8 net-caif: add CAI... |
77 78 79 80 81 82 83 84 85 86 |
this->mux = cfmuxl_create(); if (!this->mux) goto out_of_mem; this->ctrl = cfctrl_create(); if (!this->ctrl) goto out_of_mem; /* Initiate response functions */ resp = cfctrl_get_respfuncs(this->ctrl); resp->enum_rsp = cfctrl_enum_resp; resp->linkerror_ind = cfctrl_resp_func; |
e539d83cc caif: Rename func... |
87 |
resp->linkdestroy_rsp = cfcnfg_linkdestroy_rsp; |
15c9ac0c8 net-caif: add CAI... |
88 89 90 91 |
resp->sleep_rsp = cfctrl_resp_func; resp->wake_rsp = cfctrl_resp_func; resp->restart_rsp = cfctrl_resp_func; resp->radioset_rsp = cfctrl_resp_func; |
e539d83cc caif: Rename func... |
92 93 |
resp->linksetup_rsp = cfcnfg_linkup_rsp; resp->reject_rsp = cfcnfg_reject_rsp; |
f36214408 caif: Use RCU and... |
94 |
INIT_LIST_HEAD(&this->phys); |
15c9ac0c8 net-caif: add CAI... |
95 96 97 98 |
cfmuxl_set_uplayer(this->mux, this->ctrl, 0); layer_set_dn(this->ctrl, this->mux); layer_set_up(this->ctrl, this); |
f36214408 caif: Use RCU and... |
99 |
mutex_init(&this->lock); |
15c9ac0c8 net-caif: add CAI... |
100 101 |
return this; out_of_mem: |
f36214408 caif: Use RCU and... |
102 |
synchronize_rcu(); |
15c9ac0c8 net-caif: add CAI... |
103 104 105 106 107 |
kfree(this->mux); kfree(this->ctrl); kfree(this); return NULL; } |
15c9ac0c8 net-caif: add CAI... |
108 109 110 |
void cfcnfg_remove(struct cfcnfg *cfg) { |
f36214408 caif: Use RCU and... |
111 |
might_sleep(); |
15c9ac0c8 net-caif: add CAI... |
112 |
if (cfg) { |
f36214408 caif: Use RCU and... |
113 |
synchronize_rcu(); |
15c9ac0c8 net-caif: add CAI... |
114 |
kfree(cfg->mux); |
c85c2951d caif: Handle dev_... |
115 |
cfctrl_remove(cfg->ctrl); |
15c9ac0c8 net-caif: add CAI... |
116 117 118 119 120 121 122 |
kfree(cfg); } } static void cfctrl_resp_func(void) { } |
f36214408 caif: Use RCU and... |
123 124 125 126 127 128 129 130 131 132 |
static struct cfcnfg_phyinfo *cfcnfg_get_phyinfo_rcu(struct cfcnfg *cnfg, u8 phyid) { struct cfcnfg_phyinfo *phy; list_for_each_entry_rcu(phy, &cnfg->phys, node) if (phy->id == phyid) return phy; return NULL; } |
15c9ac0c8 net-caif: add CAI... |
133 134 135 |
static void cfctrl_enum_resp(void) { } |
bee925db9 caif: prepare sup... |
136 |
static struct dev_info *cfcnfg_get_phyid(struct cfcnfg *cnfg, |
15c9ac0c8 net-caif: add CAI... |
137 138 |
enum cfcnfg_phy_preference phy_pref) { |
15c9ac0c8 net-caif: add CAI... |
139 |
/* Try to match with specified preference */ |
f36214408 caif: Use RCU and... |
140 141 142 143 144 145 146 |
struct cfcnfg_phyinfo *phy; list_for_each_entry_rcu(phy, &cnfg->phys, node) { if (phy->up && phy->pref == phy_pref && phy->frm_layer != NULL) return &phy->dev_info; |
15c9ac0c8 net-caif: add CAI... |
147 |
} |
f36214408 caif: Use RCU and... |
148 149 150 151 |
/* Otherwise just return something */ list_for_each_entry_rcu(phy, &cnfg->phys, node) if (phy->up) return &phy->dev_info; |
15c9ac0c8 net-caif: add CAI... |
152 |
|
15c9ac0c8 net-caif: add CAI... |
153 154 |
return NULL; } |
bee925db9 caif: prepare sup... |
155 |
static int cfcnfg_get_id_from_ifi(struct cfcnfg *cnfg, int ifi) |
15c9ac0c8 net-caif: add CAI... |
156 |
{ |
f36214408 caif: Use RCU and... |
157 158 159 160 161 |
struct cfcnfg_phyinfo *phy; list_for_each_entry_rcu(phy, &cnfg->phys, node) if (phy->ifindex == ifi && phy->up) return phy->id; |
f2527ec43 caif: Bugfix for ... |
162 |
return -ENODEV; |
15c9ac0c8 net-caif: add CAI... |
163 |
} |
bee925db9 caif: prepare sup... |
164 |
int caif_disconnect_client(struct net *net, struct cflayer *adap_layer) |
15c9ac0c8 net-caif: add CAI... |
165 |
{ |
54e90fb5c caif: Fixes freez... |
166 |
u8 channel_id; |
bee925db9 caif: prepare sup... |
167 |
struct cfcnfg *cfg = get_cfcnfg(net); |
01a859014 caif: checking th... |
168 |
|
15c9ac0c8 net-caif: add CAI... |
169 |
caif_assert(adap_layer != NULL); |
f36214408 caif: Use RCU and... |
170 |
cfctrl_cancel_req(cfg->ctrl, adap_layer); |
54e90fb5c caif: Fixes freez... |
171 172 173 174 |
channel_id = adap_layer->id; if (channel_id != 0) { struct cflayer *servl; servl = cfmuxl_remove_uplayer(cfg->mux, channel_id); |
7c18d2205 caif: Restructure... |
175 |
cfctrl_linkdown_req(cfg->ctrl, channel_id, adap_layer); |
54e90fb5c caif: Fixes freez... |
176 177 178 179 180 |
if (servl != NULL) layer_set_up(servl, NULL); } else pr_debug("nothing to disconnect "); |
f36214408 caif: Use RCU and... |
181 182 183 |
/* Do RCU sync before initiating cleanup */ synchronize_rcu(); |
8d545c8f9 caif: Disconnect ... |
184 185 |
if (adap_layer->ctrlcmd != NULL) adap_layer->ctrlcmd(adap_layer, CAIF_CTRLCMD_DEINIT_RSP, 0); |
54e90fb5c caif: Fixes freez... |
186 |
return 0; |
15c9ac0c8 net-caif: add CAI... |
187 188 |
} |
bee925db9 caif: prepare sup... |
189 |
EXPORT_SYMBOL(caif_disconnect_client); |
5b2086567 caif: Add referen... |
190 |
|
8d545c8f9 caif: Disconnect ... |
191 |
static void cfcnfg_linkdestroy_rsp(struct cflayer *layer, u8 channel_id) |
15c9ac0c8 net-caif: add CAI... |
192 |
{ |
15c9ac0c8 net-caif: add CAI... |
193 |
} |
73d6ac633 caif: code cleanup |
194 |
static const int protohead[CFCTRL_SRV_MASK] = { |
2aa40aef9 caif: Use link la... |
195 196 197 198 199 200 |
[CFCTRL_SRV_VEI] = 4, [CFCTRL_SRV_DATAGRAM] = 7, [CFCTRL_SRV_UTIL] = 4, [CFCTRL_SRV_RFM] = 3, [CFCTRL_SRV_DBG] = 3, }; |
bee925db9 caif: prepare sup... |
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 |
static int caif_connect_req_to_link_param(struct cfcnfg *cnfg, struct caif_connect_request *s, struct cfctrl_link_param *l) { struct dev_info *dev_info; enum cfcnfg_phy_preference pref; int res; memset(l, 0, sizeof(*l)); /* In caif protocol low value is high priority */ l->priority = CAIF_PRIO_MAX - s->priority + 1; if (s->ifindex != 0) { res = cfcnfg_get_id_from_ifi(cnfg, s->ifindex); if (res < 0) return res; l->phyid = res; } else { switch (s->link_selector) { case CAIF_LINK_HIGH_BANDW: pref = CFPHYPREF_HIGH_BW; break; case CAIF_LINK_LOW_LATENCY: pref = CFPHYPREF_LOW_LAT; break; default: return -EINVAL; } dev_info = cfcnfg_get_phyid(cnfg, pref); if (dev_info == NULL) return -ENODEV; l->phyid = dev_info->id; } switch (s->protocol) { case CAIFPROTO_AT: l->linktype = CFCTRL_SRV_VEI; l->endpoint = (s->sockaddr.u.at.type >> 2) & 0x3; l->chtype = s->sockaddr.u.at.type & 0x3; break; case CAIFPROTO_DATAGRAM: l->linktype = CFCTRL_SRV_DATAGRAM; l->chtype = 0x00; l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; break; case CAIFPROTO_DATAGRAM_LOOP: l->linktype = CFCTRL_SRV_DATAGRAM; l->chtype = 0x03; l->endpoint = 0x00; l->u.datagram.connid = s->sockaddr.u.dgm.connection_id; break; case CAIFPROTO_RFM: l->linktype = CFCTRL_SRV_RFM; l->u.datagram.connid = s->sockaddr.u.rfm.connection_id; strncpy(l->u.rfm.volume, s->sockaddr.u.rfm.volume, sizeof(l->u.rfm.volume)-1); l->u.rfm.volume[sizeof(l->u.rfm.volume)-1] = 0; break; case CAIFPROTO_UTIL: l->linktype = CFCTRL_SRV_UTIL; l->endpoint = 0x00; l->chtype = 0x00; strncpy(l->u.utility.name, s->sockaddr.u.util.service, sizeof(l->u.utility.name)-1); l->u.utility.name[sizeof(l->u.utility.name)-1] = 0; caif_assert(sizeof(l->u.utility.name) > 10); l->u.utility.paramlen = s->param.size; if (l->u.utility.paramlen > sizeof(l->u.utility.params)) l->u.utility.paramlen = sizeof(l->u.utility.params); memcpy(l->u.utility.params, s->param.data, l->u.utility.paramlen); break; case CAIFPROTO_DEBUG: l->linktype = CFCTRL_SRV_DBG; l->endpoint = s->sockaddr.u.dbg.service; l->chtype = s->sockaddr.u.dbg.type; break; default: return -EINVAL; } return 0; } int caif_connect_client(struct net *net, struct caif_connect_request *conn_req, struct cflayer *adap_layer, int *ifindex, |
2aa40aef9 caif: Use link la... |
288 289 |
int *proto_head, int *proto_tail) |
15c9ac0c8 net-caif: add CAI... |
290 291 |
{ struct cflayer *frml; |
f36214408 caif: Use RCU and... |
292 293 |
struct cfcnfg_phyinfo *phy; int err; |
bee925db9 caif: prepare sup... |
294 295 296 |
struct cfctrl_link_param param; struct cfcnfg *cfg = get_cfcnfg(net); caif_assert(cfg != NULL); |
f36214408 caif: Use RCU and... |
297 298 |
rcu_read_lock(); |
bee925db9 caif: prepare sup... |
299 300 301 302 303 |
err = caif_connect_req_to_link_param(cfg, conn_req, ¶m); if (err) goto unlock; phy = cfcnfg_get_phyinfo_rcu(cfg, param.phyid); |
f36214408 caif: Use RCU and... |
304 305 306 307 308 |
if (!phy) { err = -ENODEV; goto unlock; } err = -EINVAL; |
15c9ac0c8 net-caif: add CAI... |
309 |
if (adap_layer == NULL) { |
b31fa5bad net/caif: Use pr_fmt |
310 311 |
pr_err("adap_layer is zero "); |
f36214408 caif: Use RCU and... |
312 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
313 314 |
} if (adap_layer->receive == NULL) { |
b31fa5bad net/caif: Use pr_fmt |
315 316 |
pr_err("adap_layer->receive is NULL "); |
f36214408 caif: Use RCU and... |
317 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
318 319 |
} if (adap_layer->ctrlcmd == NULL) { |
b31fa5bad net/caif: Use pr_fmt |
320 321 |
pr_err("adap_layer->ctrlcmd == NULL "); |
f36214408 caif: Use RCU and... |
322 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
323 |
} |
f36214408 caif: Use RCU and... |
324 325 326 |
err = -ENODEV; frml = phy->frm_layer; |
15c9ac0c8 net-caif: add CAI... |
327 |
if (frml == NULL) { |
b31fa5bad net/caif: Use pr_fmt |
328 329 |
pr_err("Specified PHY type does not exist! "); |
f36214408 caif: Use RCU and... |
330 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
331 |
} |
bee925db9 caif: prepare sup... |
332 |
caif_assert(param.phyid == phy->id); |
f36214408 caif: Use RCU and... |
333 |
caif_assert(phy->frm_layer->id == |
bee925db9 caif: prepare sup... |
334 |
param.phyid); |
f36214408 caif: Use RCU and... |
335 |
caif_assert(phy->phy_layer->id == |
bee925db9 caif: prepare sup... |
336 |
param.phyid); |
2aa40aef9 caif: Use link la... |
337 |
|
f36214408 caif: Use RCU and... |
338 339 |
*ifindex = phy->ifindex; *proto_tail = 2; |
7c18d2205 caif: Restructure... |
340 |
*proto_head = protohead[param.linktype] + phy->head_room; |
2aa40aef9 caif: Use link la... |
341 |
|
f36214408 caif: Use RCU and... |
342 |
rcu_read_unlock(); |
2aa40aef9 caif: Use link la... |
343 |
|
15c9ac0c8 net-caif: add CAI... |
344 |
/* FIXME: ENUMERATE INITIALLY WHEN ACTIVATING PHYSICAL INTERFACE */ |
bee925db9 caif: prepare sup... |
345 346 |
cfctrl_enum_req(cfg->ctrl, param.phyid); return cfctrl_linkup_request(cfg->ctrl, ¶m, adap_layer); |
f36214408 caif: Use RCU and... |
347 348 349 350 |
unlock: rcu_read_unlock(); return err; |
15c9ac0c8 net-caif: add CAI... |
351 |
} |
bee925db9 caif: prepare sup... |
352 |
EXPORT_SYMBOL(caif_connect_client); |
15c9ac0c8 net-caif: add CAI... |
353 |
|
e539d83cc caif: Rename func... |
354 |
static void cfcnfg_reject_rsp(struct cflayer *layer, u8 channel_id, |
15c9ac0c8 net-caif: add CAI... |
355 356 357 358 359 360 361 362 |
struct cflayer *adapt_layer) { if (adapt_layer != NULL && adapt_layer->ctrlcmd != NULL) adapt_layer->ctrlcmd(adapt_layer, CAIF_CTRLCMD_INIT_FAIL_RSP, 0); } static void |
e539d83cc caif: Rename func... |
363 |
cfcnfg_linkup_rsp(struct cflayer *layer, u8 channel_id, enum cfctrl_srv serv, |
f36214408 caif: Use RCU and... |
364 |
u8 phyid, struct cflayer *adapt_layer) |
15c9ac0c8 net-caif: add CAI... |
365 366 367 368 |
{ struct cfcnfg *cnfg = container_obj(layer); struct cflayer *servicel = NULL; struct cfcnfg_phyinfo *phyinfo; |
2aa40aef9 caif: Use link la... |
369 |
struct net_device *netdev; |
54e90fb5c caif: Fixes freez... |
370 371 372 373 374 375 376 377 |
if (channel_id == 0) { pr_warn("received channel_id zero "); if (adapt_layer != NULL && adapt_layer->ctrlcmd != NULL) adapt_layer->ctrlcmd(adapt_layer, CAIF_CTRLCMD_INIT_FAIL_RSP, 0); return; } |
f36214408 caif: Use RCU and... |
378 |
rcu_read_lock(); |
15c9ac0c8 net-caif: add CAI... |
379 |
if (adapt_layer == NULL) { |
f36214408 caif: Use RCU and... |
380 381 382 |
pr_debug("link setup response but no client exist," "send linkdown back "); |
8d545c8f9 caif: Disconnect ... |
383 |
cfctrl_linkdown_req(cnfg->ctrl, channel_id, NULL); |
f36214408 caif: Use RCU and... |
384 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
385 386 387 388 |
} caif_assert(cnfg != NULL); caif_assert(phyid != 0); |
f36214408 caif: Use RCU and... |
389 390 391 392 393 394 395 396 397 398 |
phyinfo = cfcnfg_get_phyinfo_rcu(cnfg, phyid); if (phyinfo == NULL) { pr_err("ERROR: Link Layer Device dissapeared" "while connecting "); goto unlock; } caif_assert(phyinfo != NULL); |
15c9ac0c8 net-caif: add CAI... |
399 400 401 |
caif_assert(phyinfo->id == phyid); caif_assert(phyinfo->phy_layer != NULL); caif_assert(phyinfo->phy_layer->id == phyid); |
e539d83cc caif: Rename func... |
402 |
adapt_layer->id = channel_id; |
15c9ac0c8 net-caif: add CAI... |
403 404 405 |
switch (serv) { case CFCTRL_SRV_VEI: |
e539d83cc caif: Rename func... |
406 |
servicel = cfvei_create(channel_id, &phyinfo->dev_info); |
15c9ac0c8 net-caif: add CAI... |
407 408 |
break; case CFCTRL_SRV_DATAGRAM: |
f36214408 caif: Use RCU and... |
409 410 |
servicel = cfdgml_create(channel_id, &phyinfo->dev_info); |
15c9ac0c8 net-caif: add CAI... |
411 412 |
break; case CFCTRL_SRV_RFM: |
2aa40aef9 caif: Use link la... |
413 |
netdev = phyinfo->dev_info.dev; |
a7da1f55a caif: Bugfix - RF... |
414 |
servicel = cfrfml_create(channel_id, &phyinfo->dev_info, |
2aa40aef9 caif: Use link la... |
415 |
netdev->mtu); |
15c9ac0c8 net-caif: add CAI... |
416 417 |
break; case CFCTRL_SRV_UTIL: |
e539d83cc caif: Rename func... |
418 |
servicel = cfutill_create(channel_id, &phyinfo->dev_info); |
15c9ac0c8 net-caif: add CAI... |
419 420 |
break; case CFCTRL_SRV_VIDEO: |
e539d83cc caif: Rename func... |
421 |
servicel = cfvidl_create(channel_id, &phyinfo->dev_info); |
15c9ac0c8 net-caif: add CAI... |
422 423 |
break; case CFCTRL_SRV_DBG: |
e539d83cc caif: Rename func... |
424 |
servicel = cfdbgl_create(channel_id, &phyinfo->dev_info); |
15c9ac0c8 net-caif: add CAI... |
425 426 |
break; default: |
f36214408 caif: Use RCU and... |
427 428 429 430 |
pr_err("Protocol error. Link setup response " "- unknown channel type "); goto unlock; |
15c9ac0c8 net-caif: add CAI... |
431 |
} |
7ac2ed0ce caif: Remove OOM ... |
432 |
if (!servicel) |
f36214408 caif: Use RCU and... |
433 |
goto unlock; |
15c9ac0c8 net-caif: add CAI... |
434 |
layer_set_dn(servicel, cnfg->mux); |
e539d83cc caif: Rename func... |
435 |
cfmuxl_set_uplayer(cnfg->mux, servicel, channel_id); |
15c9ac0c8 net-caif: add CAI... |
436 437 |
layer_set_up(servicel, adapt_layer); layer_set_dn(adapt_layer, servicel); |
f36214408 caif: Use RCU and... |
438 439 |
rcu_read_unlock(); |
15c9ac0c8 net-caif: add CAI... |
440 |
servicel->ctrlcmd(servicel, CAIF_CTRLCMD_INIT_RSP, 0); |
f36214408 caif: Use RCU and... |
441 442 443 |
return; unlock: rcu_read_unlock(); |
15c9ac0c8 net-caif: add CAI... |
444 445 446 |
} void |
7c18d2205 caif: Restructure... |
447 |
cfcnfg_add_phy_layer(struct cfcnfg *cnfg, |
2aa40aef9 caif: Use link la... |
448 |
struct net_device *dev, struct cflayer *phy_layer, |
bee925db9 caif: prepare sup... |
449 |
enum cfcnfg_phy_preference pref, |
7c18d2205 caif: Restructure... |
450 451 |
struct cflayer *link_support, bool fcs, int head_room) |
15c9ac0c8 net-caif: add CAI... |
452 453 |
{ struct cflayer *frml; |
5bb20ed86 caif: add error h... |
454 |
struct cfcnfg_phyinfo *phyinfo = NULL; |
15c9ac0c8 net-caif: add CAI... |
455 |
int i; |
f36214408 caif: Use RCU and... |
456 |
u8 phyid; |
15c9ac0c8 net-caif: add CAI... |
457 |
|
f36214408 caif: Use RCU and... |
458 |
mutex_lock(&cnfg->lock); |
15c9ac0c8 net-caif: add CAI... |
459 |
|
f36214408 caif: Use RCU and... |
460 461 462 463 464 465 466 |
/* CAIF protocol allow maximum 6 link-layers */ for (i = 0; i < 7; i++) { phyid = (dev->ifindex + i) & 0x7; if (phyid == 0) continue; if (cfcnfg_get_phyinfo_rcu(cnfg, phyid) == NULL) goto got_phyid; |
15c9ac0c8 net-caif: add CAI... |
467 |
} |
f36214408 caif: Use RCU and... |
468 469 |
pr_warn("Too many CAIF Link Layers (max 6) "); |
7c18d2205 caif: Restructure... |
470 |
goto out; |
f36214408 caif: Use RCU and... |
471 472 473 |
got_phyid: phyinfo = kzalloc(sizeof(struct cfcnfg_phyinfo), GFP_ATOMIC); |
5bb20ed86 caif: add error h... |
474 475 |
if (!phyinfo) goto out_err; |
15c9ac0c8 net-caif: add CAI... |
476 |
|
f36214408 caif: Use RCU and... |
477 478 479 480 481 482 483 |
phy_layer->id = phyid; phyinfo->pref = pref; phyinfo->id = phyid; phyinfo->dev_info.id = phyid; phyinfo->dev_info.dev = dev; phyinfo->phy_layer = phy_layer; phyinfo->ifindex = dev->ifindex; |
7c18d2205 caif: Restructure... |
484 |
phyinfo->head_room = head_room; |
f36214408 caif: Use RCU and... |
485 |
phyinfo->use_fcs = fcs; |
2aa40aef9 caif: Use link la... |
486 |
|
f36214408 caif: Use RCU and... |
487 |
frml = cffrml_create(phyid, fcs); |
5bb20ed86 caif: add error h... |
488 489 |
if (!frml) goto out_err; |
f36214408 caif: Use RCU and... |
490 |
phyinfo->frm_layer = frml; |
15c9ac0c8 net-caif: add CAI... |
491 |
layer_set_up(frml, cnfg->mux); |
7c18d2205 caif: Restructure... |
492 493 494 495 496 497 |
if (link_support != NULL) { link_support->id = phyid; layer_set_dn(frml, link_support); layer_set_up(link_support, frml); layer_set_dn(link_support, phy_layer); layer_set_up(phy_layer, link_support); |
15c9ac0c8 net-caif: add CAI... |
498 499 500 501 |
} else { layer_set_dn(frml, phy_layer); layer_set_up(phy_layer, frml); } |
f36214408 caif: Use RCU and... |
502 503 |
list_add_rcu(&phyinfo->node, &cnfg->phys); |
7c18d2205 caif: Restructure... |
504 |
out: |
5bb20ed86 caif: add error h... |
505 506 507 508 |
mutex_unlock(&cnfg->lock); return; out_err: |
5bb20ed86 caif: add error h... |
509 |
kfree(phyinfo); |
f36214408 caif: Use RCU and... |
510 |
mutex_unlock(&cnfg->lock); |
15c9ac0c8 net-caif: add CAI... |
511 512 |
} EXPORT_SYMBOL(cfcnfg_add_phy_layer); |
f36214408 caif: Use RCU and... |
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 |
int cfcnfg_set_phy_state(struct cfcnfg *cnfg, struct cflayer *phy_layer, bool up) { struct cfcnfg_phyinfo *phyinfo; rcu_read_lock(); phyinfo = cfcnfg_get_phyinfo_rcu(cnfg, phy_layer->id); if (phyinfo == NULL) { rcu_read_unlock(); return -ENODEV; } if (phyinfo->up == up) { rcu_read_unlock(); return 0; } phyinfo->up = up; if (up) { cffrml_hold(phyinfo->frm_layer); cfmuxl_set_dnlayer(cnfg->mux, phyinfo->frm_layer, phy_layer->id); } else { cfmuxl_remove_dnlayer(cnfg->mux, phy_layer->id); cffrml_put(phyinfo->frm_layer); } rcu_read_unlock(); return 0; } EXPORT_SYMBOL(cfcnfg_set_phy_state); |
15c9ac0c8 net-caif: add CAI... |
544 545 546 547 |
int cfcnfg_del_phy_layer(struct cfcnfg *cnfg, struct cflayer *phy_layer) { struct cflayer *frml, *frml_dn; u16 phyid; |
f36214408 caif: Use RCU and... |
548 549 550 551 552 |
struct cfcnfg_phyinfo *phyinfo; might_sleep(); mutex_lock(&cnfg->lock); |
15c9ac0c8 net-caif: add CAI... |
553 |
phyid = phy_layer->id; |
f36214408 caif: Use RCU and... |
554 |
phyinfo = cfcnfg_get_phyinfo_rcu(cnfg, phyid); |
bee925db9 caif: prepare sup... |
555 556 |
if (phyinfo == NULL) { mutex_unlock(&cnfg->lock); |
f36214408 caif: Use RCU and... |
557 |
return 0; |
bee925db9 caif: prepare sup... |
558 |
} |
f36214408 caif: Use RCU and... |
559 560 |
caif_assert(phyid == phyinfo->id); caif_assert(phy_layer == phyinfo->phy_layer); |
15c9ac0c8 net-caif: add CAI... |
561 |
caif_assert(phy_layer->id == phyid); |
f36214408 caif: Use RCU and... |
562 |
caif_assert(phyinfo->frm_layer->id == phyid); |
bee925db9 caif: prepare sup... |
563 564 |
list_del_rcu(&phyinfo->node); synchronize_rcu(); |
cb3cb423a caif: Add ref-cou... |
565 566 567 568 |
/* Fail if reference count is not zero */ if (cffrml_refcnt_read(phyinfo->frm_layer) != 0) { pr_info("Wait for device inuse "); |
bee925db9 caif: prepare sup... |
569 |
list_add_rcu(&phyinfo->node, &cnfg->phys); |
cb3cb423a caif: Add ref-cou... |
570 571 572 |
mutex_unlock(&cnfg->lock); return -EAGAIN; } |
f36214408 caif: Use RCU and... |
573 |
frml = phyinfo->frm_layer; |
15c9ac0c8 net-caif: add CAI... |
574 575 576 |
frml_dn = frml->dn; cffrml_set_uplayer(frml, NULL); cffrml_set_dnlayer(frml, NULL); |
15c9ac0c8 net-caif: add CAI... |
577 578 579 |
if (phy_layer != frml_dn) { layer_set_up(frml_dn, NULL); layer_set_dn(frml_dn, NULL); |
15c9ac0c8 net-caif: add CAI... |
580 581 |
} layer_set_up(phy_layer, NULL); |
f36214408 caif: Use RCU and... |
582 |
|
f36214408 caif: Use RCU and... |
583 584 |
if (phyinfo->phy_layer != frml_dn) kfree(frml_dn); |
cb3cb423a caif: Add ref-cou... |
585 |
cffrml_free(frml); |
f36214408 caif: Use RCU and... |
586 587 |
kfree(phyinfo); mutex_unlock(&cnfg->lock); |
15c9ac0c8 net-caif: add CAI... |
588 589 590 |
return 0; } EXPORT_SYMBOL(cfcnfg_del_phy_layer); |