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