1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright IBM Corp. 2007, 2009 4 * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, 5 * Frank Pavlic <fpavlic@de.ibm.com>, 6 * Thomas Spatzier <tspat@de.ibm.com>, 7 * Frank Blaschka <frank.blaschka@de.ibm.com> 8 */ 9 10 #define KMSG_COMPONENT "qeth" 11 #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 12 13 #include <linux/module.h> 14 #include <linux/moduleparam.h> 15 #include <linux/string.h> 16 #include <linux/errno.h> 17 #include <linux/kernel.h> 18 #include <linux/slab.h> 19 #include <linux/etherdevice.h> 20 #include <linux/list.h> 21 #include <linux/hash.h> 22 #include <linux/hashtable.h> 23 #include <asm/setup.h> 24 #include "qeth_core.h" 25 #include "qeth_l2.h" 26 27 static int qeth_l2_set_offline(struct ccwgroup_device *); 28 static void qeth_bridgeport_query_support(struct qeth_card *card); 29 static void qeth_bridge_state_change(struct qeth_card *card, 30 struct qeth_ipa_cmd *cmd); 31 static void qeth_bridge_host_event(struct qeth_card *card, 32 struct qeth_ipa_cmd *cmd); 33 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card); 34 static void qeth_l2_vnicc_init(struct qeth_card *card); 35 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 36 u32 *timeout); 37 38 static int qeth_l2_setdelmac_makerc(struct qeth_card *card, u16 retcode) 39 { 40 int rc; 41 42 if (retcode) 43 QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 44 switch (retcode) { 45 case IPA_RC_SUCCESS: 46 rc = 0; 47 break; 48 case IPA_RC_L2_UNSUPPORTED_CMD: 49 rc = -EOPNOTSUPP; 50 break; 51 case IPA_RC_L2_ADDR_TABLE_FULL: 52 rc = -ENOSPC; 53 break; 54 case IPA_RC_L2_DUP_MAC: 55 case IPA_RC_L2_DUP_LAYER3_MAC: 56 rc = -EEXIST; 57 break; 58 case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP: 59 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 60 rc = -EPERM; 61 break; 62 case IPA_RC_L2_MAC_NOT_FOUND: 63 rc = -ENOENT; 64 break; 65 default: 66 rc = -EIO; 67 break; 68 } 69 return rc; 70 } 71 72 static int qeth_l2_send_setdelmac_cb(struct qeth_card *card, 73 struct qeth_reply *reply, 74 unsigned long data) 75 { 76 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 77 78 return qeth_l2_setdelmac_makerc(card, cmd->hdr.return_code); 79 } 80 81 static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac, 82 enum qeth_ipa_cmds ipacmd) 83 { 84 struct qeth_ipa_cmd *cmd; 85 struct qeth_cmd_buffer *iob; 86 87 QETH_CARD_TEXT(card, 2, "L2sdmac"); 88 iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 89 if (!iob) 90 return -ENOMEM; 91 cmd = __ipa_cmd(iob); 92 cmd->data.setdelmac.mac_length = ETH_ALEN; 93 ether_addr_copy(cmd->data.setdelmac.mac, mac); 94 return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelmac_cb, NULL); 95 } 96 97 static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac) 98 { 99 int rc; 100 101 QETH_CARD_TEXT(card, 2, "L2Setmac"); 102 rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC); 103 if (rc == 0) { 104 dev_info(&card->gdev->dev, 105 "MAC address %pM successfully registered\n", mac); 106 } else { 107 switch (rc) { 108 case -EEXIST: 109 dev_warn(&card->gdev->dev, 110 "MAC address %pM already exists\n", mac); 111 break; 112 case -EPERM: 113 dev_warn(&card->gdev->dev, 114 "MAC address %pM is not authorized\n", mac); 115 break; 116 } 117 } 118 return rc; 119 } 120 121 static int qeth_l2_write_mac(struct qeth_card *card, u8 *mac) 122 { 123 enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 124 IPA_CMD_SETGMAC : IPA_CMD_SETVMAC; 125 int rc; 126 127 QETH_CARD_TEXT(card, 2, "L2Wmac"); 128 rc = qeth_l2_send_setdelmac(card, mac, cmd); 129 if (rc == -EEXIST) 130 QETH_DBF_MESSAGE(2, "MAC already registered on device %x\n", 131 CARD_DEVID(card)); 132 else if (rc) 133 QETH_DBF_MESSAGE(2, "Failed to register MAC on device %x: %d\n", 134 CARD_DEVID(card), rc); 135 return rc; 136 } 137 138 static int qeth_l2_remove_mac(struct qeth_card *card, u8 *mac) 139 { 140 enum qeth_ipa_cmds cmd = is_multicast_ether_addr(mac) ? 141 IPA_CMD_DELGMAC : IPA_CMD_DELVMAC; 142 int rc; 143 144 QETH_CARD_TEXT(card, 2, "L2Rmac"); 145 rc = qeth_l2_send_setdelmac(card, mac, cmd); 146 if (rc) 147 QETH_DBF_MESSAGE(2, "Failed to delete MAC on device %u: %d\n", 148 CARD_DEVID(card), rc); 149 return rc; 150 } 151 152 static void qeth_l2_drain_rx_mode_cache(struct qeth_card *card) 153 { 154 struct qeth_mac *mac; 155 struct hlist_node *tmp; 156 int i; 157 158 hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 159 hash_del(&mac->hnode); 160 kfree(mac); 161 } 162 } 163 164 static int qeth_l2_get_cast_type(struct qeth_card *card, struct sk_buff *skb) 165 { 166 if (card->info.type == QETH_CARD_TYPE_OSN) 167 return RTN_UNICAST; 168 if (is_broadcast_ether_addr(skb->data)) 169 return RTN_BROADCAST; 170 if (is_multicast_ether_addr(skb->data)) 171 return RTN_MULTICAST; 172 return RTN_UNICAST; 173 } 174 175 static void qeth_l2_fill_header(struct qeth_qdio_out_q *queue, 176 struct qeth_hdr *hdr, struct sk_buff *skb, 177 int ipv, int cast_type, unsigned int data_len) 178 { 179 struct vlan_ethhdr *veth = vlan_eth_hdr(skb); 180 181 hdr->hdr.l2.pkt_length = data_len; 182 183 if (skb_is_gso(skb)) { 184 hdr->hdr.l2.id = QETH_HEADER_TYPE_L2_TSO; 185 } else { 186 hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2; 187 if (skb->ip_summed == CHECKSUM_PARTIAL) { 188 qeth_tx_csum(skb, &hdr->hdr.l2.flags[1], ipv); 189 QETH_TXQ_STAT_INC(queue, skbs_csum); 190 } 191 } 192 193 /* set byte byte 3 to casting flags */ 194 if (cast_type == RTN_MULTICAST) 195 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST; 196 else if (cast_type == RTN_BROADCAST) 197 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST; 198 else 199 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST; 200 201 /* VSWITCH relies on the VLAN 202 * information to be present in 203 * the QDIO header */ 204 if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) { 205 hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN; 206 hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI); 207 } 208 } 209 210 static int qeth_l2_setdelvlan_makerc(struct qeth_card *card, u16 retcode) 211 { 212 if (retcode) 213 QETH_CARD_TEXT_(card, 2, "err%04x", retcode); 214 215 switch (retcode) { 216 case IPA_RC_SUCCESS: 217 return 0; 218 case IPA_RC_L2_INVALID_VLAN_ID: 219 return -EINVAL; 220 case IPA_RC_L2_DUP_VLAN_ID: 221 return -EEXIST; 222 case IPA_RC_L2_VLAN_ID_NOT_FOUND: 223 return -ENOENT; 224 case IPA_RC_L2_VLAN_ID_NOT_ALLOWED: 225 return -EPERM; 226 default: 227 return -EIO; 228 } 229 } 230 231 static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card, 232 struct qeth_reply *reply, 233 unsigned long data) 234 { 235 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 236 237 QETH_CARD_TEXT(card, 2, "L2sdvcb"); 238 if (cmd->hdr.return_code) { 239 QETH_DBF_MESSAGE(2, "Error in processing VLAN %u on device %x: %#x.\n", 240 cmd->data.setdelvlan.vlan_id, 241 CARD_DEVID(card), cmd->hdr.return_code); 242 QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command); 243 } 244 return qeth_l2_setdelvlan_makerc(card, cmd->hdr.return_code); 245 } 246 247 static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i, 248 enum qeth_ipa_cmds ipacmd) 249 { 250 struct qeth_ipa_cmd *cmd; 251 struct qeth_cmd_buffer *iob; 252 253 QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd); 254 iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4); 255 if (!iob) 256 return -ENOMEM; 257 cmd = __ipa_cmd(iob); 258 cmd->data.setdelvlan.vlan_id = i; 259 return qeth_send_ipa_cmd(card, iob, qeth_l2_send_setdelvlan_cb, NULL); 260 } 261 262 static int qeth_l2_vlan_rx_add_vid(struct net_device *dev, 263 __be16 proto, u16 vid) 264 { 265 struct qeth_card *card = dev->ml_priv; 266 267 QETH_CARD_TEXT_(card, 4, "aid:%d", vid); 268 if (!vid) 269 return 0; 270 271 return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN); 272 } 273 274 static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev, 275 __be16 proto, u16 vid) 276 { 277 struct qeth_card *card = dev->ml_priv; 278 279 QETH_CARD_TEXT_(card, 4, "kid:%d", vid); 280 if (!vid) 281 return 0; 282 283 return qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN); 284 } 285 286 static void qeth_l2_stop_card(struct qeth_card *card) 287 { 288 QETH_DBF_TEXT(SETUP , 2, "stopcard"); 289 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 290 291 qeth_set_allowed_threads(card, 0, 1); 292 293 cancel_work_sync(&card->rx_mode_work); 294 qeth_l2_drain_rx_mode_cache(card); 295 296 if (card->state == CARD_STATE_SOFTSETUP) { 297 qeth_clear_ipacmd_list(card); 298 card->state = CARD_STATE_HARDSETUP; 299 } 300 if (card->state == CARD_STATE_HARDSETUP) { 301 qeth_qdio_clear_card(card, 0); 302 qeth_clear_qdio_buffers(card); 303 qeth_clear_working_pool_list(card); 304 card->state = CARD_STATE_DOWN; 305 } 306 if (card->state == CARD_STATE_DOWN) { 307 qeth_clear_cmd_buffers(&card->read); 308 qeth_clear_cmd_buffers(&card->write); 309 } 310 311 flush_workqueue(card->event_wq); 312 card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED; 313 } 314 315 static int qeth_l2_process_inbound_buffer(struct qeth_card *card, 316 int budget, int *done) 317 { 318 int work_done = 0; 319 struct sk_buff *skb; 320 struct qeth_hdr *hdr; 321 unsigned int len; 322 323 *done = 0; 324 WARN_ON_ONCE(!budget); 325 while (budget) { 326 skb = qeth_core_get_next_skb(card, 327 &card->qdio.in_q->bufs[card->rx.b_index], 328 &card->rx.b_element, &card->rx.e_offset, &hdr); 329 if (!skb) { 330 *done = 1; 331 break; 332 } 333 switch (hdr->hdr.l2.id) { 334 case QETH_HEADER_TYPE_LAYER2: 335 skb->protocol = eth_type_trans(skb, skb->dev); 336 qeth_rx_csum(card, skb, hdr->hdr.l2.flags[1]); 337 if (skb->protocol == htons(ETH_P_802_2)) 338 *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno; 339 len = skb->len; 340 napi_gro_receive(&card->napi, skb); 341 break; 342 case QETH_HEADER_TYPE_OSN: 343 if (card->info.type == QETH_CARD_TYPE_OSN) { 344 skb_push(skb, sizeof(struct qeth_hdr)); 345 skb_copy_to_linear_data(skb, hdr, 346 sizeof(struct qeth_hdr)); 347 len = skb->len; 348 card->osn_info.data_cb(skb); 349 break; 350 } 351 /* else unknown */ 352 default: 353 dev_kfree_skb_any(skb); 354 QETH_CARD_TEXT(card, 3, "inbunkno"); 355 QETH_DBF_HEX(CTRL, 3, hdr, sizeof(*hdr)); 356 continue; 357 } 358 work_done++; 359 budget--; 360 QETH_CARD_STAT_INC(card, rx_packets); 361 QETH_CARD_STAT_ADD(card, rx_bytes, len); 362 } 363 return work_done; 364 } 365 366 static int qeth_l2_request_initial_mac(struct qeth_card *card) 367 { 368 int rc = 0; 369 370 QETH_DBF_TEXT(SETUP, 2, "l2reqmac"); 371 QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card)); 372 373 if (MACHINE_IS_VM) { 374 rc = qeth_vm_request_mac(card); 375 if (!rc) 376 goto out; 377 QETH_DBF_MESSAGE(2, "z/VM MAC Service failed on device %x: %#x\n", 378 CARD_DEVID(card), rc); 379 QETH_DBF_TEXT_(SETUP, 2, "err%04x", rc); 380 /* fall back to alternative mechanism: */ 381 } 382 383 if (!IS_OSN(card)) { 384 rc = qeth_setadpparms_change_macaddr(card); 385 if (!rc) 386 goto out; 387 QETH_DBF_MESSAGE(2, "READ_MAC Assist failed on device %x: %#x\n", 388 CARD_DEVID(card), rc); 389 QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc); 390 /* fall back once more: */ 391 } 392 393 /* some devices don't support a custom MAC address: */ 394 if (card->info.type == QETH_CARD_TYPE_OSM || 395 card->info.type == QETH_CARD_TYPE_OSX) 396 return (rc) ? rc : -EADDRNOTAVAIL; 397 eth_hw_addr_random(card->dev); 398 399 out: 400 QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, card->dev->addr_len); 401 return 0; 402 } 403 404 static void qeth_l2_register_dev_addr(struct qeth_card *card) 405 { 406 if (!is_valid_ether_addr(card->dev->dev_addr)) 407 qeth_l2_request_initial_mac(card); 408 409 if (!IS_OSN(card) && !qeth_l2_send_setmac(card, card->dev->dev_addr)) 410 card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 411 } 412 413 static int qeth_l2_validate_addr(struct net_device *dev) 414 { 415 struct qeth_card *card = dev->ml_priv; 416 417 if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 418 return eth_validate_addr(dev); 419 420 QETH_CARD_TEXT(card, 4, "nomacadr"); 421 return -EPERM; 422 } 423 424 static int qeth_l2_set_mac_address(struct net_device *dev, void *p) 425 { 426 struct sockaddr *addr = p; 427 struct qeth_card *card = dev->ml_priv; 428 u8 old_addr[ETH_ALEN]; 429 int rc = 0; 430 431 QETH_CARD_TEXT(card, 3, "setmac"); 432 433 if (IS_OSM(card) || IS_OSX(card)) { 434 QETH_CARD_TEXT(card, 3, "setmcTYP"); 435 return -EOPNOTSUPP; 436 } 437 QETH_CARD_HEX(card, 3, addr->sa_data, ETH_ALEN); 438 if (!is_valid_ether_addr(addr->sa_data)) 439 return -EADDRNOTAVAIL; 440 441 /* don't register the same address twice */ 442 if (ether_addr_equal_64bits(dev->dev_addr, addr->sa_data) && 443 (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED)) 444 return 0; 445 446 /* add the new address, switch over, drop the old */ 447 rc = qeth_l2_send_setmac(card, addr->sa_data); 448 if (rc) 449 return rc; 450 ether_addr_copy(old_addr, dev->dev_addr); 451 ether_addr_copy(dev->dev_addr, addr->sa_data); 452 453 if (card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED) 454 qeth_l2_remove_mac(card, old_addr); 455 card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED; 456 return 0; 457 } 458 459 static void qeth_promisc_to_bridge(struct qeth_card *card) 460 { 461 struct net_device *dev = card->dev; 462 enum qeth_ipa_promisc_modes promisc_mode; 463 int role; 464 int rc; 465 466 QETH_CARD_TEXT(card, 3, "pmisc2br"); 467 468 if (!card->options.sbp.reflect_promisc) 469 return; 470 promisc_mode = (dev->flags & IFF_PROMISC) ? SET_PROMISC_MODE_ON 471 : SET_PROMISC_MODE_OFF; 472 if (promisc_mode == card->info.promisc_mode) 473 return; 474 475 if (promisc_mode == SET_PROMISC_MODE_ON) { 476 if (card->options.sbp.reflect_promisc_primary) 477 role = QETH_SBP_ROLE_PRIMARY; 478 else 479 role = QETH_SBP_ROLE_SECONDARY; 480 } else 481 role = QETH_SBP_ROLE_NONE; 482 483 rc = qeth_bridgeport_setrole(card, role); 484 QETH_DBF_TEXT_(SETUP, 2, "bpm%c%04x", 485 (promisc_mode == SET_PROMISC_MODE_ON) ? '+' : '-', rc); 486 if (!rc) { 487 card->options.sbp.role = role; 488 card->info.promisc_mode = promisc_mode; 489 } 490 491 } 492 /* New MAC address is added to the hash table and marked to be written on card 493 * only if there is not in the hash table storage already 494 * 495 */ 496 static void qeth_l2_add_mac(struct qeth_card *card, struct netdev_hw_addr *ha) 497 { 498 u32 mac_hash = get_unaligned((u32 *)(&ha->addr[2])); 499 struct qeth_mac *mac; 500 501 hash_for_each_possible(card->mac_htable, mac, hnode, mac_hash) { 502 if (ether_addr_equal_64bits(ha->addr, mac->mac_addr)) { 503 mac->disp_flag = QETH_DISP_ADDR_DO_NOTHING; 504 return; 505 } 506 } 507 508 mac = kzalloc(sizeof(struct qeth_mac), GFP_ATOMIC); 509 if (!mac) 510 return; 511 512 ether_addr_copy(mac->mac_addr, ha->addr); 513 mac->disp_flag = QETH_DISP_ADDR_ADD; 514 515 hash_add(card->mac_htable, &mac->hnode, mac_hash); 516 } 517 518 static void qeth_l2_rx_mode_work(struct work_struct *work) 519 { 520 struct qeth_card *card = container_of(work, struct qeth_card, 521 rx_mode_work); 522 struct net_device *dev = card->dev; 523 struct netdev_hw_addr *ha; 524 struct qeth_mac *mac; 525 struct hlist_node *tmp; 526 int i; 527 int rc; 528 529 QETH_CARD_TEXT(card, 3, "setmulti"); 530 531 netif_addr_lock_bh(dev); 532 netdev_for_each_mc_addr(ha, dev) 533 qeth_l2_add_mac(card, ha); 534 netdev_for_each_uc_addr(ha, dev) 535 qeth_l2_add_mac(card, ha); 536 netif_addr_unlock_bh(dev); 537 538 hash_for_each_safe(card->mac_htable, i, tmp, mac, hnode) { 539 switch (mac->disp_flag) { 540 case QETH_DISP_ADDR_DELETE: 541 qeth_l2_remove_mac(card, mac->mac_addr); 542 hash_del(&mac->hnode); 543 kfree(mac); 544 break; 545 case QETH_DISP_ADDR_ADD: 546 rc = qeth_l2_write_mac(card, mac->mac_addr); 547 if (rc) { 548 hash_del(&mac->hnode); 549 kfree(mac); 550 break; 551 } 552 /* fall through */ 553 default: 554 /* for next call to set_rx_mode(): */ 555 mac->disp_flag = QETH_DISP_ADDR_DELETE; 556 } 557 } 558 559 if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) 560 qeth_setadp_promisc_mode(card); 561 else 562 qeth_promisc_to_bridge(card); 563 } 564 565 static int qeth_l2_xmit_osn(struct qeth_card *card, struct sk_buff *skb, 566 struct qeth_qdio_out_q *queue) 567 { 568 struct qeth_hdr *hdr = (struct qeth_hdr *)skb->data; 569 addr_t end = (addr_t)(skb->data + sizeof(*hdr)); 570 addr_t start = (addr_t)skb->data; 571 unsigned int elements = 0; 572 unsigned int hd_len = 0; 573 int rc; 574 575 if (skb->protocol == htons(ETH_P_IPV6)) 576 return -EPROTONOSUPPORT; 577 578 if (qeth_get_elements_for_range(start, end) > 1) { 579 /* Misaligned HW header, move it to its own buffer element. */ 580 hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); 581 if (!hdr) 582 return -ENOMEM; 583 hd_len = sizeof(*hdr); 584 skb_copy_from_linear_data(skb, (char *)hdr, hd_len); 585 elements++; 586 } 587 588 elements += qeth_count_elements(skb, hd_len); 589 if (elements > QETH_MAX_BUFFER_ELEMENTS(card)) { 590 rc = -E2BIG; 591 goto out; 592 } 593 594 rc = qeth_do_send_packet(card, queue, skb, hdr, hd_len, hd_len, 595 elements); 596 out: 597 if (rc && hd_len) 598 kmem_cache_free(qeth_core_header_cache, hdr); 599 return rc; 600 } 601 602 static netdev_tx_t qeth_l2_hard_start_xmit(struct sk_buff *skb, 603 struct net_device *dev) 604 { 605 struct qeth_card *card = dev->ml_priv; 606 int cast_type = qeth_l2_get_cast_type(card, skb); 607 int ipv = qeth_get_ip_version(skb); 608 struct qeth_qdio_out_q *queue; 609 int tx_bytes = skb->len; 610 int rc; 611 612 queue = qeth_get_tx_queue(card, skb, ipv, cast_type); 613 614 netif_stop_queue(dev); 615 616 if (IS_OSN(card)) 617 rc = qeth_l2_xmit_osn(card, skb, queue); 618 else 619 rc = qeth_xmit(card, skb, queue, ipv, cast_type, 620 qeth_l2_fill_header); 621 622 if (!rc) { 623 QETH_TXQ_STAT_INC(queue, tx_packets); 624 QETH_TXQ_STAT_ADD(queue, tx_bytes, tx_bytes); 625 netif_wake_queue(dev); 626 return NETDEV_TX_OK; 627 } else if (rc == -EBUSY) { 628 return NETDEV_TX_BUSY; 629 } /* else fall through */ 630 631 QETH_TXQ_STAT_INC(queue, tx_dropped); 632 kfree_skb(skb); 633 netif_wake_queue(dev); 634 return NETDEV_TX_OK; 635 } 636 637 static const struct device_type qeth_l2_devtype = { 638 .name = "qeth_layer2", 639 .groups = qeth_l2_attr_groups, 640 }; 641 642 static int qeth_l2_probe_device(struct ccwgroup_device *gdev) 643 { 644 struct qeth_card *card = dev_get_drvdata(&gdev->dev); 645 int rc; 646 647 qeth_l2_vnicc_set_defaults(card); 648 649 if (gdev->dev.type == &qeth_generic_devtype) { 650 rc = qeth_l2_create_device_attributes(&gdev->dev); 651 if (rc) 652 return rc; 653 } 654 655 hash_init(card->mac_htable); 656 INIT_WORK(&card->rx_mode_work, qeth_l2_rx_mode_work); 657 return 0; 658 } 659 660 static void qeth_l2_remove_device(struct ccwgroup_device *cgdev) 661 { 662 struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 663 664 if (cgdev->dev.type == &qeth_generic_devtype) 665 qeth_l2_remove_device_attributes(&cgdev->dev); 666 qeth_set_allowed_threads(card, 0, 1); 667 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 668 669 if (cgdev->state == CCWGROUP_ONLINE) 670 qeth_l2_set_offline(cgdev); 671 672 cancel_work_sync(&card->close_dev_work); 673 if (qeth_netdev_is_registered(card->dev)) 674 unregister_netdev(card->dev); 675 } 676 677 static void qeth_l2_set_rx_mode(struct net_device *dev) 678 { 679 struct qeth_card *card = dev->ml_priv; 680 681 schedule_work(&card->rx_mode_work); 682 } 683 684 static const struct net_device_ops qeth_l2_netdev_ops = { 685 .ndo_open = qeth_open, 686 .ndo_stop = qeth_stop, 687 .ndo_get_stats64 = qeth_get_stats64, 688 .ndo_start_xmit = qeth_l2_hard_start_xmit, 689 .ndo_features_check = qeth_features_check, 690 .ndo_validate_addr = qeth_l2_validate_addr, 691 .ndo_set_rx_mode = qeth_l2_set_rx_mode, 692 .ndo_do_ioctl = qeth_do_ioctl, 693 .ndo_set_mac_address = qeth_l2_set_mac_address, 694 .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid, 695 .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid, 696 .ndo_tx_timeout = qeth_tx_timeout, 697 .ndo_fix_features = qeth_fix_features, 698 .ndo_set_features = qeth_set_features 699 }; 700 701 static const struct net_device_ops qeth_osn_netdev_ops = { 702 .ndo_open = qeth_open, 703 .ndo_stop = qeth_stop, 704 .ndo_get_stats64 = qeth_get_stats64, 705 .ndo_start_xmit = qeth_l2_hard_start_xmit, 706 .ndo_validate_addr = eth_validate_addr, 707 .ndo_tx_timeout = qeth_tx_timeout, 708 }; 709 710 static int qeth_l2_setup_netdev(struct qeth_card *card, bool carrier_ok) 711 { 712 int rc; 713 714 if (IS_OSN(card)) { 715 card->dev->netdev_ops = &qeth_osn_netdev_ops; 716 card->dev->flags |= IFF_NOARP; 717 goto add_napi; 718 } 719 720 card->dev->needed_headroom = sizeof(struct qeth_hdr); 721 card->dev->netdev_ops = &qeth_l2_netdev_ops; 722 card->dev->priv_flags |= IFF_UNICAST_FLT; 723 724 if (IS_OSM(card)) { 725 card->dev->features |= NETIF_F_VLAN_CHALLENGED; 726 } else { 727 if (!IS_VM_NIC(card)) 728 card->dev->hw_features |= NETIF_F_HW_VLAN_CTAG_FILTER; 729 card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER; 730 } 731 732 if (card->info.type == QETH_CARD_TYPE_OSD && !card->info.guestlan) { 733 card->dev->features |= NETIF_F_SG; 734 /* OSA 3S and earlier has no RX/TX support */ 735 if (qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM)) { 736 card->dev->hw_features |= NETIF_F_IP_CSUM; 737 card->dev->vlan_features |= NETIF_F_IP_CSUM; 738 } 739 } 740 if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) { 741 card->dev->hw_features |= NETIF_F_IPV6_CSUM; 742 card->dev->vlan_features |= NETIF_F_IPV6_CSUM; 743 } 744 if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM) || 745 qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6)) { 746 card->dev->hw_features |= NETIF_F_RXCSUM; 747 card->dev->vlan_features |= NETIF_F_RXCSUM; 748 } 749 if (qeth_is_supported(card, IPA_OUTBOUND_TSO)) { 750 card->dev->hw_features |= NETIF_F_TSO; 751 card->dev->vlan_features |= NETIF_F_TSO; 752 } 753 if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) { 754 card->dev->hw_features |= NETIF_F_TSO6; 755 card->dev->vlan_features |= NETIF_F_TSO6; 756 } 757 758 if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6)) { 759 card->dev->needed_headroom = sizeof(struct qeth_hdr_tso); 760 netif_set_gso_max_size(card->dev, 761 PAGE_SIZE * (QDIO_MAX_ELEMENTS_PER_BUFFER - 1)); 762 } 763 764 add_napi: 765 netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT); 766 rc = register_netdev(card->dev); 767 if (!rc && carrier_ok) 768 netif_carrier_on(card->dev); 769 770 if (rc) 771 card->dev->netdev_ops = NULL; 772 return rc; 773 } 774 775 static int qeth_l2_start_ipassists(struct qeth_card *card) 776 { 777 /* configure isolation level */ 778 if (qeth_set_access_ctrl_online(card, 0)) 779 return -ENODEV; 780 return 0; 781 } 782 783 static void qeth_l2_trace_features(struct qeth_card *card) 784 { 785 /* Set BridgePort features */ 786 QETH_CARD_TEXT(card, 2, "featuSBP"); 787 QETH_CARD_HEX(card, 2, &card->options.sbp.supported_funcs, 788 sizeof(card->options.sbp.supported_funcs)); 789 /* VNIC Characteristics features */ 790 QETH_CARD_TEXT(card, 2, "feaVNICC"); 791 QETH_CARD_HEX(card, 2, &card->options.vnicc.sup_chars, 792 sizeof(card->options.vnicc.sup_chars)); 793 } 794 795 static int qeth_l2_set_online(struct ccwgroup_device *gdev) 796 { 797 struct qeth_card *card = dev_get_drvdata(&gdev->dev); 798 struct net_device *dev = card->dev; 799 int rc = 0; 800 bool carrier_ok; 801 802 mutex_lock(&card->discipline_mutex); 803 mutex_lock(&card->conf_mutex); 804 QETH_DBF_TEXT(SETUP, 2, "setonlin"); 805 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); 806 807 rc = qeth_core_hardsetup_card(card, &carrier_ok); 808 if (rc) { 809 QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc); 810 rc = -ENODEV; 811 goto out_remove; 812 } 813 814 if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) { 815 if (card->info.hwtrap && 816 qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM)) 817 card->info.hwtrap = 0; 818 } else 819 card->info.hwtrap = 0; 820 821 qeth_bridgeport_query_support(card); 822 if (card->options.sbp.supported_funcs) 823 dev_info(&card->gdev->dev, 824 "The device represents a Bridge Capable Port\n"); 825 826 qeth_l2_register_dev_addr(card); 827 828 /* for the rx_bcast characteristic, init VNICC after setmac */ 829 qeth_l2_vnicc_init(card); 830 831 qeth_trace_features(card); 832 qeth_l2_trace_features(card); 833 834 qeth_l2_setup_bridgeport_attrs(card); 835 836 card->state = CARD_STATE_HARDSETUP; 837 qeth_print_status_message(card); 838 839 /* softsetup */ 840 QETH_DBF_TEXT(SETUP, 2, "softsetp"); 841 842 if ((card->info.type == QETH_CARD_TYPE_OSD) || 843 (card->info.type == QETH_CARD_TYPE_OSX)) { 844 rc = qeth_l2_start_ipassists(card); 845 if (rc) 846 goto out_remove; 847 } 848 849 rc = qeth_init_qdio_queues(card); 850 if (rc) { 851 QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc); 852 rc = -ENODEV; 853 goto out_remove; 854 } 855 card->state = CARD_STATE_SOFTSETUP; 856 857 qeth_set_allowed_threads(card, 0xffffffff, 0); 858 859 if (!qeth_netdev_is_registered(dev)) { 860 rc = qeth_l2_setup_netdev(card, carrier_ok); 861 if (rc) 862 goto out_remove; 863 } else { 864 rtnl_lock(); 865 if (carrier_ok) 866 netif_carrier_on(dev); 867 else 868 netif_carrier_off(dev); 869 870 netif_device_attach(dev); 871 qeth_enable_hw_features(dev); 872 873 if (card->info.open_when_online) { 874 card->info.open_when_online = 0; 875 dev_open(dev, NULL); 876 } 877 rtnl_unlock(); 878 } 879 /* let user_space know that device is online */ 880 kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE); 881 mutex_unlock(&card->conf_mutex); 882 mutex_unlock(&card->discipline_mutex); 883 return 0; 884 885 out_remove: 886 qeth_l2_stop_card(card); 887 ccw_device_set_offline(CARD_DDEV(card)); 888 ccw_device_set_offline(CARD_WDEV(card)); 889 ccw_device_set_offline(CARD_RDEV(card)); 890 qdio_free(CARD_DDEV(card)); 891 card->state = CARD_STATE_DOWN; 892 893 mutex_unlock(&card->conf_mutex); 894 mutex_unlock(&card->discipline_mutex); 895 return rc; 896 } 897 898 static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev, 899 int recovery_mode) 900 { 901 struct qeth_card *card = dev_get_drvdata(&cgdev->dev); 902 int rc = 0, rc2 = 0, rc3 = 0; 903 904 mutex_lock(&card->discipline_mutex); 905 mutex_lock(&card->conf_mutex); 906 QETH_DBF_TEXT(SETUP, 3, "setoffl"); 907 QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *)); 908 909 if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) { 910 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM); 911 card->info.hwtrap = 1; 912 } 913 914 rtnl_lock(); 915 card->info.open_when_online = card->dev->flags & IFF_UP; 916 dev_close(card->dev); 917 netif_device_detach(card->dev); 918 netif_carrier_off(card->dev); 919 rtnl_unlock(); 920 921 qeth_l2_stop_card(card); 922 rc = ccw_device_set_offline(CARD_DDEV(card)); 923 rc2 = ccw_device_set_offline(CARD_WDEV(card)); 924 rc3 = ccw_device_set_offline(CARD_RDEV(card)); 925 if (!rc) 926 rc = (rc2) ? rc2 : rc3; 927 if (rc) 928 QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc); 929 qdio_free(CARD_DDEV(card)); 930 931 /* let user_space know that device is offline */ 932 kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE); 933 mutex_unlock(&card->conf_mutex); 934 mutex_unlock(&card->discipline_mutex); 935 return 0; 936 } 937 938 static int qeth_l2_set_offline(struct ccwgroup_device *cgdev) 939 { 940 return __qeth_l2_set_offline(cgdev, 0); 941 } 942 943 static int qeth_l2_recover(void *ptr) 944 { 945 struct qeth_card *card; 946 int rc = 0; 947 948 card = (struct qeth_card *) ptr; 949 QETH_CARD_TEXT(card, 2, "recover1"); 950 if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD)) 951 return 0; 952 QETH_CARD_TEXT(card, 2, "recover2"); 953 dev_warn(&card->gdev->dev, 954 "A recovery process has been started for the device\n"); 955 __qeth_l2_set_offline(card->gdev, 1); 956 rc = qeth_l2_set_online(card->gdev); 957 if (!rc) 958 dev_info(&card->gdev->dev, 959 "Device successfully recovered!\n"); 960 else { 961 ccwgroup_set_offline(card->gdev); 962 dev_warn(&card->gdev->dev, "The qeth device driver " 963 "failed to recover an error on the device\n"); 964 } 965 qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD); 966 qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD); 967 return 0; 968 } 969 970 static int __init qeth_l2_init(void) 971 { 972 pr_info("register layer 2 discipline\n"); 973 return 0; 974 } 975 976 static void __exit qeth_l2_exit(void) 977 { 978 pr_info("unregister layer 2 discipline\n"); 979 } 980 981 static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev) 982 { 983 struct qeth_card *card = dev_get_drvdata(&gdev->dev); 984 985 qeth_set_allowed_threads(card, 0, 1); 986 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0); 987 if (gdev->state == CCWGROUP_OFFLINE) 988 return 0; 989 990 qeth_l2_set_offline(gdev); 991 return 0; 992 } 993 994 static int qeth_l2_pm_resume(struct ccwgroup_device *gdev) 995 { 996 struct qeth_card *card = dev_get_drvdata(&gdev->dev); 997 int rc; 998 999 rc = qeth_l2_set_online(gdev); 1000 1001 qeth_set_allowed_threads(card, 0xffffffff, 0); 1002 if (rc) 1003 dev_warn(&card->gdev->dev, "The qeth device driver " 1004 "failed to recover an error on the device\n"); 1005 return rc; 1006 } 1007 1008 /* Returns zero if the command is successfully "consumed" */ 1009 static int qeth_l2_control_event(struct qeth_card *card, 1010 struct qeth_ipa_cmd *cmd) 1011 { 1012 switch (cmd->hdr.command) { 1013 case IPA_CMD_SETBRIDGEPORT_OSA: 1014 case IPA_CMD_SETBRIDGEPORT_IQD: 1015 if (cmd->data.sbp.hdr.command_code == 1016 IPA_SBP_BRIDGE_PORT_STATE_CHANGE) { 1017 qeth_bridge_state_change(card, cmd); 1018 return 0; 1019 } else 1020 return 1; 1021 case IPA_CMD_ADDRESS_CHANGE_NOTIF: 1022 qeth_bridge_host_event(card, cmd); 1023 return 0; 1024 default: 1025 return 1; 1026 } 1027 } 1028 1029 struct qeth_discipline qeth_l2_discipline = { 1030 .devtype = &qeth_l2_devtype, 1031 .process_rx_buffer = qeth_l2_process_inbound_buffer, 1032 .recover = qeth_l2_recover, 1033 .setup = qeth_l2_probe_device, 1034 .remove = qeth_l2_remove_device, 1035 .set_online = qeth_l2_set_online, 1036 .set_offline = qeth_l2_set_offline, 1037 .freeze = qeth_l2_pm_suspend, 1038 .thaw = qeth_l2_pm_resume, 1039 .restore = qeth_l2_pm_resume, 1040 .do_ioctl = NULL, 1041 .control_event_handler = qeth_l2_control_event, 1042 }; 1043 EXPORT_SYMBOL_GPL(qeth_l2_discipline); 1044 1045 static int qeth_osn_send_control_data(struct qeth_card *card, int len, 1046 struct qeth_cmd_buffer *iob) 1047 { 1048 struct qeth_channel *channel = iob->channel; 1049 int rc = 0; 1050 1051 QETH_CARD_TEXT(card, 5, "osndctrd"); 1052 1053 wait_event(card->wait_q, qeth_trylock_channel(channel)); 1054 iob->finalize(card, iob, len); 1055 QETH_DBF_HEX(CTRL, 2, iob->data, min(len, QETH_DBF_CTRL_LEN)); 1056 QETH_CARD_TEXT(card, 6, "osnoirqp"); 1057 spin_lock_irq(get_ccwdev_lock(channel->ccwdev)); 1058 rc = ccw_device_start_timeout(channel->ccwdev, channel->ccw, 1059 (addr_t) iob, 0, 0, iob->timeout); 1060 spin_unlock_irq(get_ccwdev_lock(channel->ccwdev)); 1061 if (rc) { 1062 QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: " 1063 "ccw_device_start rc = %i\n", rc); 1064 QETH_CARD_TEXT_(card, 2, " err%d", rc); 1065 qeth_release_buffer(channel, iob); 1066 atomic_set(&channel->irq_pending, 0); 1067 wake_up(&card->wait_q); 1068 } 1069 return rc; 1070 } 1071 1072 static int qeth_osn_send_ipa_cmd(struct qeth_card *card, 1073 struct qeth_cmd_buffer *iob) 1074 { 1075 u16 length; 1076 1077 QETH_CARD_TEXT(card, 4, "osndipa"); 1078 1079 memcpy(&length, QETH_IPA_PDU_LEN_TOTAL(iob->data), 2); 1080 return qeth_osn_send_control_data(card, length, iob); 1081 } 1082 1083 int qeth_osn_assist(struct net_device *dev, void *data, int data_len) 1084 { 1085 struct qeth_cmd_buffer *iob; 1086 struct qeth_card *card; 1087 1088 if (!dev) 1089 return -ENODEV; 1090 card = dev->ml_priv; 1091 if (!card) 1092 return -ENODEV; 1093 QETH_CARD_TEXT(card, 2, "osnsdmc"); 1094 if (!qeth_card_hw_is_reachable(card)) 1095 return -ENODEV; 1096 iob = qeth_wait_for_buffer(&card->write); 1097 qeth_prepare_ipa_cmd(card, iob, (u16) data_len); 1098 memcpy(__ipa_cmd(iob), data, data_len); 1099 return qeth_osn_send_ipa_cmd(card, iob); 1100 } 1101 EXPORT_SYMBOL(qeth_osn_assist); 1102 1103 int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev, 1104 int (*assist_cb)(struct net_device *, void *), 1105 int (*data_cb)(struct sk_buff *)) 1106 { 1107 struct qeth_card *card; 1108 char bus_id[16]; 1109 u16 devno; 1110 1111 memcpy(&devno, read_dev_no, 2); 1112 sprintf(bus_id, "0.0.%04x", devno); 1113 card = qeth_get_card_by_busid(bus_id); 1114 if (!card || !IS_OSN(card)) 1115 return -ENODEV; 1116 *dev = card->dev; 1117 1118 QETH_CARD_TEXT(card, 2, "osnreg"); 1119 if ((assist_cb == NULL) || (data_cb == NULL)) 1120 return -EINVAL; 1121 card->osn_info.assist_cb = assist_cb; 1122 card->osn_info.data_cb = data_cb; 1123 return 0; 1124 } 1125 EXPORT_SYMBOL(qeth_osn_register); 1126 1127 void qeth_osn_deregister(struct net_device *dev) 1128 { 1129 struct qeth_card *card; 1130 1131 if (!dev) 1132 return; 1133 card = dev->ml_priv; 1134 if (!card) 1135 return; 1136 QETH_CARD_TEXT(card, 2, "osndereg"); 1137 card->osn_info.assist_cb = NULL; 1138 card->osn_info.data_cb = NULL; 1139 return; 1140 } 1141 EXPORT_SYMBOL(qeth_osn_deregister); 1142 1143 /* SETBRIDGEPORT support, async notifications */ 1144 1145 enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset}; 1146 1147 /** 1148 * qeth_bridge_emit_host_event() - bridgeport address change notification 1149 * @card: qeth_card structure pointer, for udev events. 1150 * @evtype: "normal" register/unregister, or abort, or reset. For abort 1151 * and reset token and addr_lnid are unused and may be NULL. 1152 * @code: event bitmask: high order bit 0x80 value 1 means removal of an 1153 * object, 0 - addition of an object. 1154 * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC. 1155 * @token: "network token" structure identifying physical address of the port. 1156 * @addr_lnid: pointer to structure with MAC address and VLAN ID. 1157 * 1158 * This function is called when registrations and deregistrations are 1159 * reported by the hardware, and also when notifications are enabled - 1160 * for all currently registered addresses. 1161 */ 1162 static void qeth_bridge_emit_host_event(struct qeth_card *card, 1163 enum qeth_an_event_type evtype, 1164 u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid) 1165 { 1166 char str[7][32]; 1167 char *env[8]; 1168 int i = 0; 1169 1170 switch (evtype) { 1171 case anev_reg_unreg: 1172 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s", 1173 (code & IPA_ADDR_CHANGE_CODE_REMOVAL) 1174 ? "deregister" : "register"); 1175 env[i] = str[i]; i++; 1176 if (code & IPA_ADDR_CHANGE_CODE_VLANID) { 1177 snprintf(str[i], sizeof(str[i]), "VLAN=%d", 1178 addr_lnid->lnid); 1179 env[i] = str[i]; i++; 1180 } 1181 if (code & IPA_ADDR_CHANGE_CODE_MACADDR) { 1182 snprintf(str[i], sizeof(str[i]), "MAC=%pM", 1183 addr_lnid->mac); 1184 env[i] = str[i]; i++; 1185 } 1186 snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x", 1187 token->cssid, token->ssid, token->devnum); 1188 env[i] = str[i]; i++; 1189 snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid); 1190 env[i] = str[i]; i++; 1191 snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x", 1192 token->chpid); 1193 env[i] = str[i]; i++; 1194 snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid); 1195 env[i] = str[i]; i++; 1196 break; 1197 case anev_abort: 1198 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort"); 1199 env[i] = str[i]; i++; 1200 break; 1201 case anev_reset: 1202 snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset"); 1203 env[i] = str[i]; i++; 1204 break; 1205 } 1206 env[i] = NULL; 1207 kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env); 1208 } 1209 1210 struct qeth_bridge_state_data { 1211 struct work_struct worker; 1212 struct qeth_card *card; 1213 struct qeth_sbp_state_change qports; 1214 }; 1215 1216 static void qeth_bridge_state_change_worker(struct work_struct *work) 1217 { 1218 struct qeth_bridge_state_data *data = 1219 container_of(work, struct qeth_bridge_state_data, worker); 1220 /* We are only interested in the first entry - local port */ 1221 struct qeth_sbp_port_entry *entry = &data->qports.entry[0]; 1222 char env_locrem[32]; 1223 char env_role[32]; 1224 char env_state[32]; 1225 char *env[] = { 1226 env_locrem, 1227 env_role, 1228 env_state, 1229 NULL 1230 }; 1231 1232 /* Role should not change by itself, but if it did, */ 1233 /* information from the hardware is authoritative. */ 1234 mutex_lock(&data->card->conf_mutex); 1235 data->card->options.sbp.role = entry->role; 1236 mutex_unlock(&data->card->conf_mutex); 1237 1238 snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange"); 1239 snprintf(env_role, sizeof(env_role), "ROLE=%s", 1240 (entry->role == QETH_SBP_ROLE_NONE) ? "none" : 1241 (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" : 1242 (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" : 1243 "<INVALID>"); 1244 snprintf(env_state, sizeof(env_state), "STATE=%s", 1245 (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" : 1246 (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" : 1247 (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" : 1248 "<INVALID>"); 1249 kobject_uevent_env(&data->card->gdev->dev.kobj, 1250 KOBJ_CHANGE, env); 1251 kfree(data); 1252 } 1253 1254 static void qeth_bridge_state_change(struct qeth_card *card, 1255 struct qeth_ipa_cmd *cmd) 1256 { 1257 struct qeth_sbp_state_change *qports = 1258 &cmd->data.sbp.data.state_change; 1259 struct qeth_bridge_state_data *data; 1260 int extrasize; 1261 1262 QETH_CARD_TEXT(card, 2, "brstchng"); 1263 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1264 QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length); 1265 return; 1266 } 1267 extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries; 1268 data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize, 1269 GFP_ATOMIC); 1270 if (!data) { 1271 QETH_CARD_TEXT(card, 2, "BPSalloc"); 1272 return; 1273 } 1274 INIT_WORK(&data->worker, qeth_bridge_state_change_worker); 1275 data->card = card; 1276 memcpy(&data->qports, qports, 1277 sizeof(struct qeth_sbp_state_change) + extrasize); 1278 queue_work(card->event_wq, &data->worker); 1279 } 1280 1281 struct qeth_bridge_host_data { 1282 struct work_struct worker; 1283 struct qeth_card *card; 1284 struct qeth_ipacmd_addr_change hostevs; 1285 }; 1286 1287 static void qeth_bridge_host_event_worker(struct work_struct *work) 1288 { 1289 struct qeth_bridge_host_data *data = 1290 container_of(work, struct qeth_bridge_host_data, worker); 1291 int i; 1292 1293 if (data->hostevs.lost_event_mask) { 1294 dev_info(&data->card->gdev->dev, 1295 "Address notification from the Bridge Port stopped %s (%s)\n", 1296 data->card->dev->name, 1297 (data->hostevs.lost_event_mask == 0x01) 1298 ? "Overflow" 1299 : (data->hostevs.lost_event_mask == 0x02) 1300 ? "Bridge port state change" 1301 : "Unknown reason"); 1302 mutex_lock(&data->card->conf_mutex); 1303 data->card->options.sbp.hostnotification = 0; 1304 mutex_unlock(&data->card->conf_mutex); 1305 qeth_bridge_emit_host_event(data->card, anev_abort, 1306 0, NULL, NULL); 1307 } else 1308 for (i = 0; i < data->hostevs.num_entries; i++) { 1309 struct qeth_ipacmd_addr_change_entry *entry = 1310 &data->hostevs.entry[i]; 1311 qeth_bridge_emit_host_event(data->card, 1312 anev_reg_unreg, 1313 entry->change_code, 1314 &entry->token, &entry->addr_lnid); 1315 } 1316 kfree(data); 1317 } 1318 1319 static void qeth_bridge_host_event(struct qeth_card *card, 1320 struct qeth_ipa_cmd *cmd) 1321 { 1322 struct qeth_ipacmd_addr_change *hostevs = 1323 &cmd->data.addrchange; 1324 struct qeth_bridge_host_data *data; 1325 int extrasize; 1326 1327 QETH_CARD_TEXT(card, 2, "brhostev"); 1328 if (cmd->hdr.return_code != 0x0000) { 1329 if (cmd->hdr.return_code == 0x0010) { 1330 if (hostevs->lost_event_mask == 0x00) 1331 hostevs->lost_event_mask = 0xff; 1332 } else { 1333 QETH_CARD_TEXT_(card, 2, "BPHe%04x", 1334 cmd->hdr.return_code); 1335 return; 1336 } 1337 } 1338 extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) * 1339 hostevs->num_entries; 1340 data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize, 1341 GFP_ATOMIC); 1342 if (!data) { 1343 QETH_CARD_TEXT(card, 2, "BPHalloc"); 1344 return; 1345 } 1346 INIT_WORK(&data->worker, qeth_bridge_host_event_worker); 1347 data->card = card; 1348 memcpy(&data->hostevs, hostevs, 1349 sizeof(struct qeth_ipacmd_addr_change) + extrasize); 1350 queue_work(card->event_wq, &data->worker); 1351 } 1352 1353 /* SETBRIDGEPORT support; sending commands */ 1354 1355 struct _qeth_sbp_cbctl { 1356 union { 1357 u32 supported; 1358 struct { 1359 enum qeth_sbp_roles *role; 1360 enum qeth_sbp_states *state; 1361 } qports; 1362 } data; 1363 }; 1364 1365 static int qeth_bridgeport_makerc(struct qeth_card *card, 1366 struct qeth_ipa_cmd *cmd) 1367 { 1368 struct qeth_ipacmd_setbridgeport *sbp = &cmd->data.sbp; 1369 enum qeth_ipa_sbp_cmd setcmd = sbp->hdr.command_code; 1370 u16 ipa_rc = cmd->hdr.return_code; 1371 u16 sbp_rc = sbp->hdr.return_code; 1372 int rc; 1373 1374 if (ipa_rc == IPA_RC_SUCCESS && sbp_rc == IPA_RC_SUCCESS) 1375 return 0; 1376 1377 if ((IS_IQD(card) && ipa_rc == IPA_RC_SUCCESS) || 1378 (!IS_IQD(card) && ipa_rc == sbp_rc)) { 1379 switch (sbp_rc) { 1380 case IPA_RC_SUCCESS: 1381 rc = 0; 1382 break; 1383 case IPA_RC_L2_UNSUPPORTED_CMD: 1384 case IPA_RC_UNSUPPORTED_COMMAND: 1385 rc = -EOPNOTSUPP; 1386 break; 1387 case IPA_RC_SBP_OSA_NOT_CONFIGURED: 1388 case IPA_RC_SBP_IQD_NOT_CONFIGURED: 1389 rc = -ENODEV; /* maybe not the best code here? */ 1390 dev_err(&card->gdev->dev, 1391 "The device is not configured as a Bridge Port\n"); 1392 break; 1393 case IPA_RC_SBP_OSA_OS_MISMATCH: 1394 case IPA_RC_SBP_IQD_OS_MISMATCH: 1395 rc = -EPERM; 1396 dev_err(&card->gdev->dev, 1397 "A Bridge Port is already configured by a different operating system\n"); 1398 break; 1399 case IPA_RC_SBP_OSA_ANO_DEV_PRIMARY: 1400 case IPA_RC_SBP_IQD_ANO_DEV_PRIMARY: 1401 switch (setcmd) { 1402 case IPA_SBP_SET_PRIMARY_BRIDGE_PORT: 1403 rc = -EEXIST; 1404 dev_err(&card->gdev->dev, 1405 "The LAN already has a primary Bridge Port\n"); 1406 break; 1407 case IPA_SBP_SET_SECONDARY_BRIDGE_PORT: 1408 rc = -EBUSY; 1409 dev_err(&card->gdev->dev, 1410 "The device is already a primary Bridge Port\n"); 1411 break; 1412 default: 1413 rc = -EIO; 1414 } 1415 break; 1416 case IPA_RC_SBP_OSA_CURRENT_SECOND: 1417 case IPA_RC_SBP_IQD_CURRENT_SECOND: 1418 rc = -EBUSY; 1419 dev_err(&card->gdev->dev, 1420 "The device is already a secondary Bridge Port\n"); 1421 break; 1422 case IPA_RC_SBP_OSA_LIMIT_SECOND: 1423 case IPA_RC_SBP_IQD_LIMIT_SECOND: 1424 rc = -EEXIST; 1425 dev_err(&card->gdev->dev, 1426 "The LAN cannot have more secondary Bridge Ports\n"); 1427 break; 1428 case IPA_RC_SBP_OSA_CURRENT_PRIMARY: 1429 case IPA_RC_SBP_IQD_CURRENT_PRIMARY: 1430 rc = -EBUSY; 1431 dev_err(&card->gdev->dev, 1432 "The device is already a primary Bridge Port\n"); 1433 break; 1434 case IPA_RC_SBP_OSA_NOT_AUTHD_BY_ZMAN: 1435 case IPA_RC_SBP_IQD_NOT_AUTHD_BY_ZMAN: 1436 rc = -EACCES; 1437 dev_err(&card->gdev->dev, 1438 "The device is not authorized to be a Bridge Port\n"); 1439 break; 1440 default: 1441 rc = -EIO; 1442 } 1443 } else { 1444 switch (ipa_rc) { 1445 case IPA_RC_NOTSUPP: 1446 rc = -EOPNOTSUPP; 1447 break; 1448 case IPA_RC_UNSUPPORTED_COMMAND: 1449 rc = -EOPNOTSUPP; 1450 break; 1451 default: 1452 rc = -EIO; 1453 } 1454 } 1455 1456 if (rc) { 1457 QETH_CARD_TEXT_(card, 2, "SBPi%04x", ipa_rc); 1458 QETH_CARD_TEXT_(card, 2, "SBPc%04x", sbp_rc); 1459 } 1460 return rc; 1461 } 1462 1463 static struct qeth_cmd_buffer *qeth_sbp_build_cmd(struct qeth_card *card, 1464 enum qeth_ipa_sbp_cmd sbp_cmd, 1465 unsigned int cmd_length) 1466 { 1467 enum qeth_ipa_cmds ipa_cmd = (card->info.type == QETH_CARD_TYPE_IQD) ? 1468 IPA_CMD_SETBRIDGEPORT_IQD : 1469 IPA_CMD_SETBRIDGEPORT_OSA; 1470 struct qeth_cmd_buffer *iob; 1471 struct qeth_ipa_cmd *cmd; 1472 1473 iob = qeth_get_ipacmd_buffer(card, ipa_cmd, 0); 1474 if (!iob) 1475 return iob; 1476 cmd = __ipa_cmd(iob); 1477 cmd->data.sbp.hdr.cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) + 1478 cmd_length; 1479 cmd->data.sbp.hdr.command_code = sbp_cmd; 1480 cmd->data.sbp.hdr.used_total = 1; 1481 cmd->data.sbp.hdr.seq_no = 1; 1482 return iob; 1483 } 1484 1485 static int qeth_bridgeport_query_support_cb(struct qeth_card *card, 1486 struct qeth_reply *reply, unsigned long data) 1487 { 1488 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1489 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1490 int rc; 1491 1492 QETH_CARD_TEXT(card, 2, "brqsupcb"); 1493 rc = qeth_bridgeport_makerc(card, cmd); 1494 if (rc) 1495 return rc; 1496 1497 cbctl->data.supported = 1498 cmd->data.sbp.data.query_cmds_supp.supported_cmds; 1499 return 0; 1500 } 1501 1502 /** 1503 * qeth_bridgeport_query_support() - store bitmask of supported subfunctions. 1504 * @card: qeth_card structure pointer. 1505 * 1506 * Sets bitmask of supported setbridgeport subfunctions in the qeth_card 1507 * strucutre: card->options.sbp.supported_funcs. 1508 */ 1509 static void qeth_bridgeport_query_support(struct qeth_card *card) 1510 { 1511 struct qeth_cmd_buffer *iob; 1512 struct _qeth_sbp_cbctl cbctl; 1513 1514 QETH_CARD_TEXT(card, 2, "brqsuppo"); 1515 iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_COMMANDS_SUPPORTED, 1516 sizeof(struct qeth_sbp_query_cmds_supp)); 1517 if (!iob) 1518 return; 1519 1520 if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb, 1521 &cbctl)) { 1522 card->options.sbp.role = QETH_SBP_ROLE_NONE; 1523 card->options.sbp.supported_funcs = 0; 1524 return; 1525 } 1526 card->options.sbp.supported_funcs = cbctl.data.supported; 1527 } 1528 1529 static int qeth_bridgeport_query_ports_cb(struct qeth_card *card, 1530 struct qeth_reply *reply, unsigned long data) 1531 { 1532 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1533 struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports; 1534 struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param; 1535 int rc; 1536 1537 QETH_CARD_TEXT(card, 2, "brqprtcb"); 1538 rc = qeth_bridgeport_makerc(card, cmd); 1539 if (rc) 1540 return rc; 1541 1542 if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) { 1543 QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length); 1544 return -EINVAL; 1545 } 1546 /* first entry contains the state of the local port */ 1547 if (qports->num_entries > 0) { 1548 if (cbctl->data.qports.role) 1549 *cbctl->data.qports.role = qports->entry[0].role; 1550 if (cbctl->data.qports.state) 1551 *cbctl->data.qports.state = qports->entry[0].state; 1552 } 1553 return 0; 1554 } 1555 1556 /** 1557 * qeth_bridgeport_query_ports() - query local bridgeport status. 1558 * @card: qeth_card structure pointer. 1559 * @role: Role of the port: 0-none, 1-primary, 2-secondary. 1560 * @state: State of the port: 0-inactive, 1-standby, 2-active. 1561 * 1562 * Returns negative errno-compatible error indication or 0 on success. 1563 * 1564 * 'role' and 'state' are not updated in case of hardware operation failure. 1565 */ 1566 int qeth_bridgeport_query_ports(struct qeth_card *card, 1567 enum qeth_sbp_roles *role, enum qeth_sbp_states *state) 1568 { 1569 struct qeth_cmd_buffer *iob; 1570 struct _qeth_sbp_cbctl cbctl = { 1571 .data = { 1572 .qports = { 1573 .role = role, 1574 .state = state, 1575 }, 1576 }, 1577 }; 1578 1579 QETH_CARD_TEXT(card, 2, "brqports"); 1580 if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS)) 1581 return -EOPNOTSUPP; 1582 iob = qeth_sbp_build_cmd(card, IPA_SBP_QUERY_BRIDGE_PORTS, 0); 1583 if (!iob) 1584 return -ENOMEM; 1585 1586 return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb, 1587 &cbctl); 1588 } 1589 1590 static int qeth_bridgeport_set_cb(struct qeth_card *card, 1591 struct qeth_reply *reply, unsigned long data) 1592 { 1593 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data; 1594 1595 QETH_CARD_TEXT(card, 2, "brsetrcb"); 1596 return qeth_bridgeport_makerc(card, cmd); 1597 } 1598 1599 /** 1600 * qeth_bridgeport_setrole() - Assign primary role to the port. 1601 * @card: qeth_card structure pointer. 1602 * @role: Role to assign. 1603 * 1604 * Returns negative errno-compatible error indication or 0 on success. 1605 */ 1606 int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role) 1607 { 1608 int cmdlength; 1609 struct qeth_cmd_buffer *iob; 1610 enum qeth_ipa_sbp_cmd setcmd; 1611 1612 QETH_CARD_TEXT(card, 2, "brsetrol"); 1613 switch (role) { 1614 case QETH_SBP_ROLE_NONE: 1615 setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE; 1616 cmdlength = sizeof(struct qeth_sbp_reset_role); 1617 break; 1618 case QETH_SBP_ROLE_PRIMARY: 1619 setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT; 1620 cmdlength = sizeof(struct qeth_sbp_set_primary); 1621 break; 1622 case QETH_SBP_ROLE_SECONDARY: 1623 setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT; 1624 cmdlength = sizeof(struct qeth_sbp_set_secondary); 1625 break; 1626 default: 1627 return -EINVAL; 1628 } 1629 if (!(card->options.sbp.supported_funcs & setcmd)) 1630 return -EOPNOTSUPP; 1631 iob = qeth_sbp_build_cmd(card, setcmd, cmdlength); 1632 if (!iob) 1633 return -ENOMEM; 1634 1635 return qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb, NULL); 1636 } 1637 1638 /** 1639 * qeth_anset_makerc() - derive "traditional" error from hardware codes. 1640 * @card: qeth_card structure pointer, for debug messages. 1641 * 1642 * Returns negative errno-compatible error indication or 0 on success. 1643 */ 1644 static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response) 1645 { 1646 int rc; 1647 1648 if (pnso_rc == 0) 1649 switch (response) { 1650 case 0x0001: 1651 rc = 0; 1652 break; 1653 case 0x0004: 1654 case 0x0100: 1655 case 0x0106: 1656 rc = -EOPNOTSUPP; 1657 dev_err(&card->gdev->dev, 1658 "Setting address notification failed\n"); 1659 break; 1660 case 0x0107: 1661 rc = -EAGAIN; 1662 break; 1663 default: 1664 rc = -EIO; 1665 } 1666 else 1667 rc = -EIO; 1668 1669 if (rc) { 1670 QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc); 1671 QETH_CARD_TEXT_(card, 2, "SBPr%04x", response); 1672 } 1673 return rc; 1674 } 1675 1676 static void qeth_bridgeport_an_set_cb(void *priv, 1677 enum qdio_brinfo_entry_type type, void *entry) 1678 { 1679 struct qeth_card *card = (struct qeth_card *)priv; 1680 struct qdio_brinfo_entry_l2 *l2entry; 1681 u8 code; 1682 1683 if (type != l2_addr_lnid) { 1684 WARN_ON_ONCE(1); 1685 return; 1686 } 1687 1688 l2entry = (struct qdio_brinfo_entry_l2 *)entry; 1689 code = IPA_ADDR_CHANGE_CODE_MACADDR; 1690 if (l2entry->addr_lnid.lnid) 1691 code |= IPA_ADDR_CHANGE_CODE_VLANID; 1692 qeth_bridge_emit_host_event(card, anev_reg_unreg, code, 1693 (struct net_if_token *)&l2entry->nit, 1694 (struct mac_addr_lnid *)&l2entry->addr_lnid); 1695 } 1696 1697 /** 1698 * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification 1699 * @card: qeth_card structure pointer. 1700 * @enable: 0 - disable, non-zero - enable notifications 1701 * 1702 * Returns negative errno-compatible error indication or 0 on success. 1703 * 1704 * On enable, emits a series of address notifications udev events for all 1705 * currently registered hosts. 1706 */ 1707 int qeth_bridgeport_an_set(struct qeth_card *card, int enable) 1708 { 1709 int rc; 1710 u16 response; 1711 struct ccw_device *ddev; 1712 struct subchannel_id schid; 1713 1714 if (!card) 1715 return -EINVAL; 1716 if (!card->options.sbp.supported_funcs) 1717 return -EOPNOTSUPP; 1718 ddev = CARD_DDEV(card); 1719 ccw_device_get_schid(ddev, &schid); 1720 1721 if (enable) { 1722 qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL); 1723 rc = qdio_pnso_brinfo(schid, 1, &response, 1724 qeth_bridgeport_an_set_cb, card); 1725 } else 1726 rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL); 1727 return qeth_anset_makerc(card, rc, response); 1728 } 1729 1730 static bool qeth_bridgeport_is_in_use(struct qeth_card *card) 1731 { 1732 return (card->options.sbp.role || card->options.sbp.reflect_promisc || 1733 card->options.sbp.hostnotification); 1734 } 1735 1736 /* VNIC Characteristics support */ 1737 1738 /* handle VNICC IPA command return codes; convert to error codes */ 1739 static int qeth_l2_vnicc_makerc(struct qeth_card *card, u16 ipa_rc) 1740 { 1741 int rc; 1742 1743 switch (ipa_rc) { 1744 case IPA_RC_SUCCESS: 1745 return ipa_rc; 1746 case IPA_RC_L2_UNSUPPORTED_CMD: 1747 case IPA_RC_NOTSUPP: 1748 rc = -EOPNOTSUPP; 1749 break; 1750 case IPA_RC_VNICC_OOSEQ: 1751 rc = -EALREADY; 1752 break; 1753 case IPA_RC_VNICC_VNICBP: 1754 rc = -EBUSY; 1755 break; 1756 case IPA_RC_L2_ADDR_TABLE_FULL: 1757 rc = -ENOSPC; 1758 break; 1759 case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP: 1760 rc = -EACCES; 1761 break; 1762 default: 1763 rc = -EIO; 1764 } 1765 1766 QETH_CARD_TEXT_(card, 2, "err%04x", ipa_rc); 1767 return rc; 1768 } 1769 1770 /* generic VNICC request call back control */ 1771 struct _qeth_l2_vnicc_request_cbctl { 1772 u32 sub_cmd; 1773 struct { 1774 u32 vnic_char; 1775 u32 timeout; 1776 } param; 1777 struct { 1778 union{ 1779 u32 *sup_cmds; 1780 u32 *timeout; 1781 }; 1782 } result; 1783 }; 1784 1785 /* generic VNICC request call back */ 1786 static int qeth_l2_vnicc_request_cb(struct qeth_card *card, 1787 struct qeth_reply *reply, 1788 unsigned long data) 1789 { 1790 struct _qeth_l2_vnicc_request_cbctl *cbctl = 1791 (struct _qeth_l2_vnicc_request_cbctl *) reply->param; 1792 struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data; 1793 struct qeth_ipacmd_vnicc *rep = &cmd->data.vnicc; 1794 1795 QETH_CARD_TEXT(card, 2, "vniccrcb"); 1796 if (cmd->hdr.return_code) 1797 return qeth_l2_vnicc_makerc(card, cmd->hdr.return_code); 1798 /* return results to caller */ 1799 card->options.vnicc.sup_chars = rep->hdr.sup; 1800 card->options.vnicc.cur_chars = rep->hdr.cur; 1801 1802 if (cbctl->sub_cmd == IPA_VNICC_QUERY_CMDS) 1803 *cbctl->result.sup_cmds = rep->query_cmds.sup_cmds; 1804 1805 if (cbctl->sub_cmd == IPA_VNICC_GET_TIMEOUT) 1806 *cbctl->result.timeout = rep->getset_timeout.timeout; 1807 1808 return 0; 1809 } 1810 1811 /* generic VNICC request */ 1812 static int qeth_l2_vnicc_request(struct qeth_card *card, 1813 struct _qeth_l2_vnicc_request_cbctl *cbctl) 1814 { 1815 struct qeth_ipacmd_vnicc *req; 1816 struct qeth_cmd_buffer *iob; 1817 struct qeth_ipa_cmd *cmd; 1818 1819 QETH_CARD_TEXT(card, 2, "vniccreq"); 1820 1821 /* get new buffer for request */ 1822 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_VNICC, 0); 1823 if (!iob) 1824 return -ENOMEM; 1825 1826 /* create header for request */ 1827 cmd = __ipa_cmd(iob); 1828 req = &cmd->data.vnicc; 1829 1830 /* create sub command header for request */ 1831 req->sub_hdr.data_length = sizeof(req->sub_hdr); 1832 req->sub_hdr.sub_command = cbctl->sub_cmd; 1833 1834 /* create sub command specific request fields */ 1835 switch (cbctl->sub_cmd) { 1836 case IPA_VNICC_QUERY_CHARS: 1837 break; 1838 case IPA_VNICC_QUERY_CMDS: 1839 req->sub_hdr.data_length += sizeof(req->query_cmds); 1840 req->query_cmds.vnic_char = cbctl->param.vnic_char; 1841 break; 1842 case IPA_VNICC_ENABLE: 1843 case IPA_VNICC_DISABLE: 1844 req->sub_hdr.data_length += sizeof(req->set_char); 1845 req->set_char.vnic_char = cbctl->param.vnic_char; 1846 break; 1847 case IPA_VNICC_SET_TIMEOUT: 1848 req->getset_timeout.timeout = cbctl->param.timeout; 1849 /* fallthrough */ 1850 case IPA_VNICC_GET_TIMEOUT: 1851 req->sub_hdr.data_length += sizeof(req->getset_timeout); 1852 req->getset_timeout.vnic_char = cbctl->param.vnic_char; 1853 break; 1854 default: 1855 qeth_release_buffer(iob->channel, iob); 1856 return -EOPNOTSUPP; 1857 } 1858 1859 /* send request */ 1860 return qeth_send_ipa_cmd(card, iob, qeth_l2_vnicc_request_cb, cbctl); 1861 } 1862 1863 /* VNICC query VNIC characteristics request */ 1864 static int qeth_l2_vnicc_query_chars(struct qeth_card *card) 1865 { 1866 struct _qeth_l2_vnicc_request_cbctl cbctl; 1867 1868 /* prepare callback control */ 1869 cbctl.sub_cmd = IPA_VNICC_QUERY_CHARS; 1870 1871 QETH_CARD_TEXT(card, 2, "vniccqch"); 1872 return qeth_l2_vnicc_request(card, &cbctl); 1873 } 1874 1875 /* VNICC query sub commands request */ 1876 static int qeth_l2_vnicc_query_cmds(struct qeth_card *card, u32 vnic_char, 1877 u32 *sup_cmds) 1878 { 1879 struct _qeth_l2_vnicc_request_cbctl cbctl; 1880 1881 /* prepare callback control */ 1882 cbctl.sub_cmd = IPA_VNICC_QUERY_CMDS; 1883 cbctl.param.vnic_char = vnic_char; 1884 cbctl.result.sup_cmds = sup_cmds; 1885 1886 QETH_CARD_TEXT(card, 2, "vniccqcm"); 1887 return qeth_l2_vnicc_request(card, &cbctl); 1888 } 1889 1890 /* VNICC enable/disable characteristic request */ 1891 static int qeth_l2_vnicc_set_char(struct qeth_card *card, u32 vnic_char, 1892 u32 cmd) 1893 { 1894 struct _qeth_l2_vnicc_request_cbctl cbctl; 1895 1896 /* prepare callback control */ 1897 cbctl.sub_cmd = cmd; 1898 cbctl.param.vnic_char = vnic_char; 1899 1900 QETH_CARD_TEXT(card, 2, "vniccedc"); 1901 return qeth_l2_vnicc_request(card, &cbctl); 1902 } 1903 1904 /* VNICC get/set timeout for characteristic request */ 1905 static int qeth_l2_vnicc_getset_timeout(struct qeth_card *card, u32 vnicc, 1906 u32 cmd, u32 *timeout) 1907 { 1908 struct _qeth_l2_vnicc_request_cbctl cbctl; 1909 1910 /* prepare callback control */ 1911 cbctl.sub_cmd = cmd; 1912 cbctl.param.vnic_char = vnicc; 1913 if (cmd == IPA_VNICC_SET_TIMEOUT) 1914 cbctl.param.timeout = *timeout; 1915 if (cmd == IPA_VNICC_GET_TIMEOUT) 1916 cbctl.result.timeout = timeout; 1917 1918 QETH_CARD_TEXT(card, 2, "vniccgst"); 1919 return qeth_l2_vnicc_request(card, &cbctl); 1920 } 1921 1922 /* set current VNICC flag state; called from sysfs store function */ 1923 int qeth_l2_vnicc_set_state(struct qeth_card *card, u32 vnicc, bool state) 1924 { 1925 int rc = 0; 1926 u32 cmd; 1927 1928 QETH_CARD_TEXT(card, 2, "vniccsch"); 1929 1930 /* do not change anything if BridgePort is enabled */ 1931 if (qeth_bridgeport_is_in_use(card)) 1932 return -EBUSY; 1933 1934 /* check if characteristic and enable/disable are supported */ 1935 if (!(card->options.vnicc.sup_chars & vnicc) || 1936 !(card->options.vnicc.set_char_sup & vnicc)) 1937 return -EOPNOTSUPP; 1938 1939 /* set enable/disable command and store wanted characteristic */ 1940 if (state) { 1941 cmd = IPA_VNICC_ENABLE; 1942 card->options.vnicc.wanted_chars |= vnicc; 1943 } else { 1944 cmd = IPA_VNICC_DISABLE; 1945 card->options.vnicc.wanted_chars &= ~vnicc; 1946 } 1947 1948 /* do we need to do anything? */ 1949 if (card->options.vnicc.cur_chars == card->options.vnicc.wanted_chars) 1950 return rc; 1951 1952 /* if card is not ready, simply stop here */ 1953 if (!qeth_card_hw_is_reachable(card)) { 1954 if (state) 1955 card->options.vnicc.cur_chars |= vnicc; 1956 else 1957 card->options.vnicc.cur_chars &= ~vnicc; 1958 return rc; 1959 } 1960 1961 rc = qeth_l2_vnicc_set_char(card, vnicc, cmd); 1962 if (rc) 1963 card->options.vnicc.wanted_chars = 1964 card->options.vnicc.cur_chars; 1965 else { 1966 /* successful online VNICC change; handle special cases */ 1967 if (state && vnicc == QETH_VNICC_RX_BCAST) 1968 card->options.vnicc.rx_bcast_enabled = true; 1969 if (!state && vnicc == QETH_VNICC_LEARNING) 1970 qeth_l2_vnicc_recover_timeout(card, vnicc, 1971 &card->options.vnicc.learning_timeout); 1972 } 1973 1974 return rc; 1975 } 1976 1977 /* get current VNICC flag state; called from sysfs show function */ 1978 int qeth_l2_vnicc_get_state(struct qeth_card *card, u32 vnicc, bool *state) 1979 { 1980 int rc = 0; 1981 1982 QETH_CARD_TEXT(card, 2, "vniccgch"); 1983 1984 /* do not get anything if BridgePort is enabled */ 1985 if (qeth_bridgeport_is_in_use(card)) 1986 return -EBUSY; 1987 1988 /* check if characteristic is supported */ 1989 if (!(card->options.vnicc.sup_chars & vnicc)) 1990 return -EOPNOTSUPP; 1991 1992 /* if card is ready, query current VNICC state */ 1993 if (qeth_card_hw_is_reachable(card)) 1994 rc = qeth_l2_vnicc_query_chars(card); 1995 1996 *state = (card->options.vnicc.cur_chars & vnicc) ? true : false; 1997 return rc; 1998 } 1999 2000 /* set VNICC timeout; called from sysfs store function. Currently, only learning 2001 * supports timeout 2002 */ 2003 int qeth_l2_vnicc_set_timeout(struct qeth_card *card, u32 timeout) 2004 { 2005 int rc = 0; 2006 2007 QETH_CARD_TEXT(card, 2, "vniccsto"); 2008 2009 /* do not change anything if BridgePort is enabled */ 2010 if (qeth_bridgeport_is_in_use(card)) 2011 return -EBUSY; 2012 2013 /* check if characteristic and set_timeout are supported */ 2014 if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2015 !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2016 return -EOPNOTSUPP; 2017 2018 /* do we need to do anything? */ 2019 if (card->options.vnicc.learning_timeout == timeout) 2020 return rc; 2021 2022 /* if card is not ready, simply store the value internally and return */ 2023 if (!qeth_card_hw_is_reachable(card)) { 2024 card->options.vnicc.learning_timeout = timeout; 2025 return rc; 2026 } 2027 2028 /* send timeout value to card; if successful, store value internally */ 2029 rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2030 IPA_VNICC_SET_TIMEOUT, &timeout); 2031 if (!rc) 2032 card->options.vnicc.learning_timeout = timeout; 2033 2034 return rc; 2035 } 2036 2037 /* get current VNICC timeout; called from sysfs show function. Currently, only 2038 * learning supports timeout 2039 */ 2040 int qeth_l2_vnicc_get_timeout(struct qeth_card *card, u32 *timeout) 2041 { 2042 int rc = 0; 2043 2044 QETH_CARD_TEXT(card, 2, "vniccgto"); 2045 2046 /* do not get anything if BridgePort is enabled */ 2047 if (qeth_bridgeport_is_in_use(card)) 2048 return -EBUSY; 2049 2050 /* check if characteristic and get_timeout are supported */ 2051 if (!(card->options.vnicc.sup_chars & QETH_VNICC_LEARNING) || 2052 !(card->options.vnicc.getset_timeout_sup & QETH_VNICC_LEARNING)) 2053 return -EOPNOTSUPP; 2054 /* if card is ready, get timeout. Otherwise, just return stored value */ 2055 *timeout = card->options.vnicc.learning_timeout; 2056 if (qeth_card_hw_is_reachable(card)) 2057 rc = qeth_l2_vnicc_getset_timeout(card, QETH_VNICC_LEARNING, 2058 IPA_VNICC_GET_TIMEOUT, 2059 timeout); 2060 2061 return rc; 2062 } 2063 2064 /* check if VNICC is currently enabled */ 2065 bool qeth_l2_vnicc_is_in_use(struct qeth_card *card) 2066 { 2067 /* if everything is turned off, VNICC is not active */ 2068 if (!card->options.vnicc.cur_chars) 2069 return false; 2070 /* default values are only OK if rx_bcast was not enabled by user 2071 * or the card is offline. 2072 */ 2073 if (card->options.vnicc.cur_chars == QETH_VNICC_DEFAULT) { 2074 if (!card->options.vnicc.rx_bcast_enabled || 2075 !qeth_card_hw_is_reachable(card)) 2076 return false; 2077 } 2078 return true; 2079 } 2080 2081 /* recover user timeout setting */ 2082 static bool qeth_l2_vnicc_recover_timeout(struct qeth_card *card, u32 vnicc, 2083 u32 *timeout) 2084 { 2085 if (card->options.vnicc.sup_chars & vnicc && 2086 card->options.vnicc.getset_timeout_sup & vnicc && 2087 !qeth_l2_vnicc_getset_timeout(card, vnicc, IPA_VNICC_SET_TIMEOUT, 2088 timeout)) 2089 return false; 2090 *timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2091 return true; 2092 } 2093 2094 /* recover user characteristic setting */ 2095 static bool qeth_l2_vnicc_recover_char(struct qeth_card *card, u32 vnicc, 2096 bool enable) 2097 { 2098 u32 cmd = enable ? IPA_VNICC_ENABLE : IPA_VNICC_DISABLE; 2099 2100 if (card->options.vnicc.sup_chars & vnicc && 2101 card->options.vnicc.set_char_sup & vnicc && 2102 !qeth_l2_vnicc_set_char(card, vnicc, cmd)) 2103 return false; 2104 card->options.vnicc.wanted_chars &= ~vnicc; 2105 card->options.vnicc.wanted_chars |= QETH_VNICC_DEFAULT & vnicc; 2106 return true; 2107 } 2108 2109 /* (re-)initialize VNICC */ 2110 static void qeth_l2_vnicc_init(struct qeth_card *card) 2111 { 2112 u32 *timeout = &card->options.vnicc.learning_timeout; 2113 unsigned int chars_len, i; 2114 unsigned long chars_tmp; 2115 u32 sup_cmds, vnicc; 2116 bool enable, error; 2117 2118 QETH_CARD_TEXT(card, 2, "vniccini"); 2119 /* reset rx_bcast */ 2120 card->options.vnicc.rx_bcast_enabled = 0; 2121 /* initial query and storage of VNIC characteristics */ 2122 if (qeth_l2_vnicc_query_chars(card)) { 2123 if (card->options.vnicc.wanted_chars != QETH_VNICC_DEFAULT || 2124 *timeout != QETH_VNICC_DEFAULT_TIMEOUT) 2125 dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2126 /* fail quietly if user didn't change the default config */ 2127 card->options.vnicc.sup_chars = 0; 2128 card->options.vnicc.cur_chars = 0; 2129 card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2130 return; 2131 } 2132 /* get supported commands for each supported characteristic */ 2133 chars_tmp = card->options.vnicc.sup_chars; 2134 chars_len = sizeof(card->options.vnicc.sup_chars) * BITS_PER_BYTE; 2135 for_each_set_bit(i, &chars_tmp, chars_len) { 2136 vnicc = BIT(i); 2137 qeth_l2_vnicc_query_cmds(card, vnicc, &sup_cmds); 2138 if (!(sup_cmds & IPA_VNICC_SET_TIMEOUT) || 2139 !(sup_cmds & IPA_VNICC_GET_TIMEOUT)) 2140 card->options.vnicc.getset_timeout_sup &= ~vnicc; 2141 if (!(sup_cmds & IPA_VNICC_ENABLE) || 2142 !(sup_cmds & IPA_VNICC_DISABLE)) 2143 card->options.vnicc.set_char_sup &= ~vnicc; 2144 } 2145 /* enforce assumed default values and recover settings, if changed */ 2146 error = qeth_l2_vnicc_recover_timeout(card, QETH_VNICC_LEARNING, 2147 timeout); 2148 chars_tmp = card->options.vnicc.wanted_chars ^ QETH_VNICC_DEFAULT; 2149 chars_tmp |= QETH_VNICC_BRIDGE_INVISIBLE; 2150 chars_len = sizeof(card->options.vnicc.wanted_chars) * BITS_PER_BYTE; 2151 for_each_set_bit(i, &chars_tmp, chars_len) { 2152 vnicc = BIT(i); 2153 enable = card->options.vnicc.wanted_chars & vnicc; 2154 error |= qeth_l2_vnicc_recover_char(card, vnicc, enable); 2155 } 2156 if (error) 2157 dev_err(&card->gdev->dev, "Configuring the VNIC characteristics failed\n"); 2158 } 2159 2160 /* configure default values of VNIC characteristics */ 2161 static void qeth_l2_vnicc_set_defaults(struct qeth_card *card) 2162 { 2163 /* characteristics values */ 2164 card->options.vnicc.sup_chars = QETH_VNICC_ALL; 2165 card->options.vnicc.cur_chars = QETH_VNICC_DEFAULT; 2166 card->options.vnicc.learning_timeout = QETH_VNICC_DEFAULT_TIMEOUT; 2167 /* supported commands */ 2168 card->options.vnicc.set_char_sup = QETH_VNICC_ALL; 2169 card->options.vnicc.getset_timeout_sup = QETH_VNICC_LEARNING; 2170 /* settings wanted by users */ 2171 card->options.vnicc.wanted_chars = QETH_VNICC_DEFAULT; 2172 } 2173 2174 module_init(qeth_l2_init); 2175 module_exit(qeth_l2_exit); 2176 MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>"); 2177 MODULE_DESCRIPTION("qeth layer 2 discipline"); 2178 MODULE_LICENSE("GPL"); 2179