drivers/s390/net/qeth_l2_main.c

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