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