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