diff options
-rw-r--r-- | net/caif/cfctrl.c | 35 |
1 files changed, 26 insertions, 9 deletions
diff --git a/net/caif/cfctrl.c b/net/caif/cfctrl.c index 0c00a6015dda..f8ac31371a4a 100644 --- a/net/caif/cfctrl.c +++ b/net/caif/cfctrl.c | |||
@@ -178,20 +178,23 @@ static void init_info(struct caif_payload_info *info, struct cfctrl *cfctrl) | |||
178 | void cfctrl_enum_req(struct cflayer *layer, u8 physlinkid) | 178 | void cfctrl_enum_req(struct cflayer *layer, u8 physlinkid) |
179 | { | 179 | { |
180 | struct cfctrl *cfctrl = container_obj(layer); | 180 | struct cfctrl *cfctrl = container_obj(layer); |
181 | int ret; | ||
182 | struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN); | 181 | struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN); |
182 | struct cflayer *dn = cfctrl->serv.layer.dn; | ||
183 | if (!pkt) { | 183 | if (!pkt) { |
184 | pr_warn("Out of memory\n"); | 184 | pr_warn("Out of memory\n"); |
185 | return; | 185 | return; |
186 | } | 186 | } |
187 | if (!dn) { | ||
188 | pr_debug("not able to send enum request\n"); | ||
189 | return; | ||
190 | } | ||
187 | caif_assert(offsetof(struct cfctrl, serv.layer) == 0); | 191 | caif_assert(offsetof(struct cfctrl, serv.layer) == 0); |
188 | init_info(cfpkt_info(pkt), cfctrl); | 192 | init_info(cfpkt_info(pkt), cfctrl); |
189 | cfpkt_info(pkt)->dev_info->id = physlinkid; | 193 | cfpkt_info(pkt)->dev_info->id = physlinkid; |
190 | cfctrl->serv.dev_info.id = physlinkid; | 194 | cfctrl->serv.dev_info.id = physlinkid; |
191 | cfpkt_addbdy(pkt, CFCTRL_CMD_ENUM); | 195 | cfpkt_addbdy(pkt, CFCTRL_CMD_ENUM); |
192 | cfpkt_addbdy(pkt, physlinkid); | 196 | cfpkt_addbdy(pkt, physlinkid); |
193 | ret = | 197 | dn->transmit(dn, pkt); |
194 | cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt); | ||
195 | } | 198 | } |
196 | 199 | ||
197 | int cfctrl_linkup_request(struct cflayer *layer, | 200 | int cfctrl_linkup_request(struct cflayer *layer, |
@@ -206,6 +209,12 @@ int cfctrl_linkup_request(struct cflayer *layer, | |||
206 | int ret; | 209 | int ret; |
207 | char utility_name[16]; | 210 | char utility_name[16]; |
208 | struct cfpkt *pkt; | 211 | struct cfpkt *pkt; |
212 | struct cflayer *dn = cfctrl->serv.layer.dn; | ||
213 | |||
214 | if (!dn) { | ||
215 | pr_debug("not able to send linkup request\n"); | ||
216 | return -ENODEV; | ||
217 | } | ||
209 | 218 | ||
210 | if (cfctrl_cancel_req(layer, user_layer) > 0) { | 219 | if (cfctrl_cancel_req(layer, user_layer) > 0) { |
211 | /* Slight Paranoia, check if already connecting */ | 220 | /* Slight Paranoia, check if already connecting */ |
@@ -282,7 +291,7 @@ int cfctrl_linkup_request(struct cflayer *layer, | |||
282 | */ | 291 | */ |
283 | cfpkt_info(pkt)->dev_info->id = param->phyid; | 292 | cfpkt_info(pkt)->dev_info->id = param->phyid; |
284 | ret = | 293 | ret = |
285 | cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt); | 294 | dn->transmit(dn, pkt); |
286 | if (ret < 0) { | 295 | if (ret < 0) { |
287 | int count; | 296 | int count; |
288 | 297 | ||
@@ -301,15 +310,23 @@ int cfctrl_linkdown_req(struct cflayer *layer, u8 channelid, | |||
301 | int ret; | 310 | int ret; |
302 | struct cfctrl *cfctrl = container_obj(layer); | 311 | struct cfctrl *cfctrl = container_obj(layer); |
303 | struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN); | 312 | struct cfpkt *pkt = cfpkt_create(CFPKT_CTRL_PKT_LEN); |
313 | struct cflayer *dn = cfctrl->serv.layer.dn; | ||
314 | |||
304 | if (!pkt) { | 315 | if (!pkt) { |
305 | pr_warn("Out of memory\n"); | 316 | pr_warn("Out of memory\n"); |
306 | return -ENOMEM; | 317 | return -ENOMEM; |
307 | } | 318 | } |
319 | |||
320 | if (!dn) { | ||
321 | pr_debug("not able to send link-down request\n"); | ||
322 | return -ENODEV; | ||
323 | } | ||
324 | |||
308 | cfpkt_addbdy(pkt, CFCTRL_CMD_LINK_DESTROY); | 325 | cfpkt_addbdy(pkt, CFCTRL_CMD_LINK_DESTROY); |
309 | cfpkt_addbdy(pkt, channelid); | 326 | cfpkt_addbdy(pkt, channelid); |
310 | init_info(cfpkt_info(pkt), cfctrl); | 327 | init_info(cfpkt_info(pkt), cfctrl); |
311 | ret = | 328 | ret = |
312 | cfctrl->serv.layer.dn->transmit(cfctrl->serv.layer.dn, pkt); | 329 | dn->transmit(dn, pkt); |
313 | #ifndef CAIF_NO_LOOP | 330 | #ifndef CAIF_NO_LOOP |
314 | cfctrl->loop_linkused[channelid] = 0; | 331 | cfctrl->loop_linkused[channelid] = 0; |
315 | #endif | 332 | #endif |
@@ -477,7 +494,7 @@ static int cfctrl_recv(struct cflayer *layer, struct cfpkt *pkt) | |||
477 | cfpkt_extr_head(pkt, ¶m, len); | 494 | cfpkt_extr_head(pkt, ¶m, len); |
478 | break; | 495 | break; |
479 | default: | 496 | default: |
480 | pr_warn("Request setup - invalid link type (%d)\n", | 497 | pr_warn("Request setup, invalid type (%d)\n", |
481 | serv); | 498 | serv); |
482 | goto error; | 499 | goto error; |
483 | } | 500 | } |
@@ -489,7 +506,8 @@ static int cfctrl_recv(struct cflayer *layer, struct cfpkt *pkt) | |||
489 | 506 | ||
490 | if (CFCTRL_ERR_BIT == (CFCTRL_ERR_BIT & cmdrsp) || | 507 | if (CFCTRL_ERR_BIT == (CFCTRL_ERR_BIT & cmdrsp) || |
491 | cfpkt_erroneous(pkt)) { | 508 | cfpkt_erroneous(pkt)) { |
492 | pr_err("Invalid O/E bit or parse error on CAIF control channel\n"); | 509 | pr_err("Invalid O/E bit or parse error " |
510 | "on CAIF control channel\n"); | ||
493 | cfctrl->res.reject_rsp(cfctrl->serv.layer.up, | 511 | cfctrl->res.reject_rsp(cfctrl->serv.layer.up, |
494 | 0, | 512 | 0, |
495 | req ? req->client_layer | 513 | req ? req->client_layer |
@@ -550,9 +568,8 @@ static void cfctrl_ctrlcmd(struct cflayer *layr, enum caif_ctrlcmd ctrl, | |||
550 | case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND: | 568 | case _CAIF_CTRLCMD_PHYIF_FLOW_OFF_IND: |
551 | case CAIF_CTRLCMD_FLOW_OFF_IND: | 569 | case CAIF_CTRLCMD_FLOW_OFF_IND: |
552 | spin_lock_bh(&this->info_list_lock); | 570 | spin_lock_bh(&this->info_list_lock); |
553 | if (!list_empty(&this->list)) { | 571 | if (!list_empty(&this->list)) |
554 | pr_debug("Received flow off in control layer\n"); | 572 | pr_debug("Received flow off in control layer\n"); |
555 | } | ||
556 | spin_unlock_bh(&this->info_list_lock); | 573 | spin_unlock_bh(&this->info_list_lock); |
557 | break; | 574 | break; |
558 | case _CAIF_CTRLCMD_PHYIF_DOWN_IND: { | 575 | case _CAIF_CTRLCMD_PHYIF_DOWN_IND: { |