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