| /* |
| * Copyright IBM Corp. 2007, 2009 |
| * Author(s): Utz Bacher <utz.bacher@de.ibm.com>, |
| * Frank Pavlic <fpavlic@de.ibm.com>, |
| * Thomas Spatzier <tspat@de.ibm.com>, |
| * Frank Blaschka <frank.blaschka@de.ibm.com> |
| */ |
| |
| #define KMSG_COMPONENT "qeth" |
| #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt |
| |
| #include <linux/module.h> |
| #include <linux/moduleparam.h> |
| #include <linux/bitops.h> |
| #include <linux/string.h> |
| #include <linux/errno.h> |
| #include <linux/kernel.h> |
| #include <linux/etherdevice.h> |
| #include <linux/ip.h> |
| #include <linux/ipv6.h> |
| #include <linux/inetdevice.h> |
| #include <linux/igmp.h> |
| #include <linux/slab.h> |
| #include <linux/if_vlan.h> |
| |
| #include <net/ip.h> |
| #include <net/arp.h> |
| #include <net/route.h> |
| #include <net/ip6_fib.h> |
| #include <net/ip6_checksum.h> |
| #include <net/iucv/af_iucv.h> |
| #include <linux/hashtable.h> |
| |
| #include "qeth_l3.h" |
| |
| |
| static int qeth_l3_set_offline(struct ccwgroup_device *); |
| static int qeth_l3_stop(struct net_device *); |
| static void qeth_l3_set_multicast_list(struct net_device *); |
| static int qeth_l3_register_addr_entry(struct qeth_card *, |
| struct qeth_ipaddr *); |
| static int qeth_l3_deregister_addr_entry(struct qeth_card *, |
| struct qeth_ipaddr *); |
| |
| static int qeth_l3_isxdigit(char *buf) |
| { |
| while (*buf) { |
| if (!isxdigit(*buf++)) |
| return 0; |
| } |
| return 1; |
| } |
| |
| static void qeth_l3_ipaddr4_to_string(const __u8 *addr, char *buf) |
| { |
| sprintf(buf, "%pI4", addr); |
| } |
| |
| static int qeth_l3_string_to_ipaddr4(const char *buf, __u8 *addr) |
| { |
| int count = 0, rc = 0; |
| unsigned int in[4]; |
| char c; |
| |
| rc = sscanf(buf, "%u.%u.%u.%u%c", |
| &in[0], &in[1], &in[2], &in[3], &c); |
| if (rc != 4 && (rc != 5 || c != '\n')) |
| return -EINVAL; |
| for (count = 0; count < 4; count++) { |
| if (in[count] > 255) |
| return -EINVAL; |
| addr[count] = in[count]; |
| } |
| return 0; |
| } |
| |
| static void qeth_l3_ipaddr6_to_string(const __u8 *addr, char *buf) |
| { |
| sprintf(buf, "%pI6", addr); |
| } |
| |
| static int qeth_l3_string_to_ipaddr6(const char *buf, __u8 *addr) |
| { |
| const char *end, *end_tmp, *start; |
| __u16 *in; |
| char num[5]; |
| int num2, cnt, out, found, save_cnt; |
| unsigned short in_tmp[8] = {0, }; |
| |
| cnt = out = found = save_cnt = num2 = 0; |
| end = start = buf; |
| in = (__u16 *) addr; |
| memset(in, 0, 16); |
| while (*end) { |
| end = strchr(start, ':'); |
| if (end == NULL) { |
| end = buf + strlen(buf); |
| end_tmp = strchr(start, '\n'); |
| if (end_tmp != NULL) |
| end = end_tmp; |
| out = 1; |
| } |
| if ((end - start)) { |
| memset(num, 0, 5); |
| if ((end - start) > 4) |
| return -EINVAL; |
| memcpy(num, start, end - start); |
| if (!qeth_l3_isxdigit(num)) |
| return -EINVAL; |
| sscanf(start, "%x", &num2); |
| if (found) |
| in_tmp[save_cnt++] = num2; |
| else |
| in[cnt++] = num2; |
| if (out) |
| break; |
| } else { |
| if (found) |
| return -EINVAL; |
| found = 1; |
| } |
| start = ++end; |
| } |
| if (cnt + save_cnt > 8) |
| return -EINVAL; |
| cnt = 7; |
| while (save_cnt) |
| in[cnt--] = in_tmp[--save_cnt]; |
| return 0; |
| } |
| |
| void qeth_l3_ipaddr_to_string(enum qeth_prot_versions proto, const __u8 *addr, |
| char *buf) |
| { |
| if (proto == QETH_PROT_IPV4) |
| qeth_l3_ipaddr4_to_string(addr, buf); |
| else if (proto == QETH_PROT_IPV6) |
| qeth_l3_ipaddr6_to_string(addr, buf); |
| } |
| |
| int qeth_l3_string_to_ipaddr(const char *buf, enum qeth_prot_versions proto, |
| __u8 *addr) |
| { |
| if (proto == QETH_PROT_IPV4) |
| return qeth_l3_string_to_ipaddr4(buf, addr); |
| else if (proto == QETH_PROT_IPV6) |
| return qeth_l3_string_to_ipaddr6(buf, addr); |
| else |
| return -EINVAL; |
| } |
| |
| static void qeth_l3_convert_addr_to_bits(u8 *addr, u8 *bits, int len) |
| { |
| int i, j; |
| u8 octet; |
| |
| for (i = 0; i < len; ++i) { |
| octet = addr[i]; |
| for (j = 7; j >= 0; --j) { |
| bits[i*8 + j] = octet & 1; |
| octet >>= 1; |
| } |
| } |
| } |
| |
| int qeth_l3_is_addr_covered_by_ipato(struct qeth_card *card, |
| struct qeth_ipaddr *addr) |
| { |
| struct qeth_ipato_entry *ipatoe; |
| u8 addr_bits[128] = {0, }; |
| u8 ipatoe_bits[128] = {0, }; |
| int rc = 0; |
| |
| if (!card->ipato.enabled) |
| return 0; |
| |
| qeth_l3_convert_addr_to_bits((u8 *) &addr->u, addr_bits, |
| (addr->proto == QETH_PROT_IPV4)? 4:16); |
| list_for_each_entry(ipatoe, &card->ipato.entries, entry) { |
| if (addr->proto != ipatoe->proto) |
| continue; |
| qeth_l3_convert_addr_to_bits(ipatoe->addr, ipatoe_bits, |
| (ipatoe->proto == QETH_PROT_IPV4) ? |
| 4 : 16); |
| if (addr->proto == QETH_PROT_IPV4) |
| rc = !memcmp(addr_bits, ipatoe_bits, |
| min(32, ipatoe->mask_bits)); |
| else |
| rc = !memcmp(addr_bits, ipatoe_bits, |
| min(128, ipatoe->mask_bits)); |
| if (rc) |
| break; |
| } |
| /* invert? */ |
| if ((addr->proto == QETH_PROT_IPV4) && card->ipato.invert4) |
| rc = !rc; |
| else if ((addr->proto == QETH_PROT_IPV6) && card->ipato.invert6) |
| rc = !rc; |
| |
| return rc; |
| } |
| |
| inline int |
| qeth_l3_ipaddrs_is_equal(struct qeth_ipaddr *addr1, struct qeth_ipaddr *addr2) |
| { |
| return addr1->proto == addr2->proto && |
| !memcmp(&addr1->u, &addr2->u, sizeof(addr1->u)) && |
| !memcmp(&addr1->mac, &addr2->mac, sizeof(addr1->mac)); |
| } |
| |
| static struct qeth_ipaddr * |
| qeth_l3_ip_from_hash(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) |
| { |
| struct qeth_ipaddr *addr; |
| |
| if (tmp_addr->is_multicast) { |
| hash_for_each_possible(card->ip_mc_htable, addr, |
| hnode, qeth_l3_ipaddr_hash(tmp_addr)) |
| if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr)) |
| return addr; |
| } else { |
| hash_for_each_possible(card->ip_htable, addr, |
| hnode, qeth_l3_ipaddr_hash(tmp_addr)) |
| if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr)) |
| return addr; |
| } |
| |
| return NULL; |
| } |
| |
| int qeth_l3_delete_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) |
| { |
| int rc = 0; |
| struct qeth_ipaddr *addr; |
| |
| QETH_CARD_TEXT(card, 4, "delip"); |
| |
| if (tmp_addr->proto == QETH_PROT_IPV4) |
| QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4); |
| else { |
| QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8); |
| QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8); |
| } |
| |
| addr = qeth_l3_ip_from_hash(card, tmp_addr); |
| if (!addr) |
| return -ENOENT; |
| |
| addr->ref_counter--; |
| if (addr->ref_counter > 0 && (addr->type == QETH_IP_TYPE_NORMAL || |
| addr->type == QETH_IP_TYPE_RXIP)) |
| return rc; |
| if (addr->in_progress) |
| return -EINPROGRESS; |
| |
| if (!qeth_card_hw_is_reachable(card)) { |
| addr->disp_flag = QETH_DISP_ADDR_DELETE; |
| return 0; |
| } |
| |
| rc = qeth_l3_deregister_addr_entry(card, addr); |
| |
| hash_del(&addr->hnode); |
| kfree(addr); |
| |
| return rc; |
| } |
| |
| int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr) |
| { |
| int rc = 0; |
| struct qeth_ipaddr *addr; |
| |
| QETH_CARD_TEXT(card, 4, "addip"); |
| |
| if (tmp_addr->proto == QETH_PROT_IPV4) |
| QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4); |
| else { |
| QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8); |
| QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8); |
| } |
| |
| addr = qeth_l3_ip_from_hash(card, tmp_addr); |
| if (!addr) { |
| addr = qeth_l3_get_addr_buffer(tmp_addr->proto); |
| if (!addr) |
| return -ENOMEM; |
| |
| memcpy(addr, tmp_addr, sizeof(struct qeth_ipaddr)); |
| addr->ref_counter = 1; |
| |
| if (addr->type == QETH_IP_TYPE_NORMAL && |
| qeth_l3_is_addr_covered_by_ipato(card, addr)) { |
| QETH_CARD_TEXT(card, 2, "tkovaddr"); |
| addr->set_flags |= QETH_IPA_SETIP_TAKEOVER_FLAG; |
| } |
| hash_add(card->ip_htable, &addr->hnode, |
| qeth_l3_ipaddr_hash(addr)); |
| |
| if (!qeth_card_hw_is_reachable(card)) { |
| addr->disp_flag = QETH_DISP_ADDR_ADD; |
| return 0; |
| } |
| |
| /* qeth_l3_register_addr_entry can go to sleep |
| * if we add a IPV4 addr. It is caused by the reason |
| * that SETIP ipa cmd starts ARP staff for IPV4 addr. |
| * Thus we should unlock spinlock, and make a protection |
| * using in_progress variable to indicate that there is |
| * an hardware operation with this IPV4 address |
| */ |
| if (addr->proto == QETH_PROT_IPV4) { |
| addr->in_progress = 1; |
| spin_unlock_bh(&card->ip_lock); |
| rc = qeth_l3_register_addr_entry(card, addr); |
| spin_lock_bh(&card->ip_lock); |
| addr->in_progress = 0; |
| } else |
| rc = qeth_l3_register_addr_entry(card, addr); |
| |
| if (!rc || (rc == IPA_RC_DUPLICATE_IP_ADDRESS) || |
| (rc == IPA_RC_LAN_OFFLINE)) { |
| addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING; |
| if (addr->ref_counter < 1) { |
| qeth_l3_delete_ip(card, addr); |
| kfree(addr); |
| } |
| } else { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } |
| } else { |
| if (addr->type == QETH_IP_TYPE_NORMAL || |
| addr->type == QETH_IP_TYPE_RXIP) |
| addr->ref_counter++; |
| } |
| |
| return rc; |
| } |
| |
| |
| struct qeth_ipaddr *qeth_l3_get_addr_buffer( |
| enum qeth_prot_versions prot) |
| { |
| struct qeth_ipaddr *addr; |
| |
| addr = kzalloc(sizeof(struct qeth_ipaddr), GFP_ATOMIC); |
| if (!addr) |
| return NULL; |
| |
| addr->type = QETH_IP_TYPE_NORMAL; |
| addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING; |
| addr->proto = prot; |
| |
| return addr; |
| } |
| |
| static void qeth_l3_clear_ip_htable(struct qeth_card *card, int recover) |
| { |
| struct qeth_ipaddr *addr; |
| struct hlist_node *tmp; |
| int i; |
| |
| QETH_CARD_TEXT(card, 4, "clearip"); |
| |
| if (recover && card->options.sniffer) |
| return; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) { |
| if (!recover) { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| continue; |
| } |
| addr->disp_flag = QETH_DISP_ADDR_ADD; |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| spin_lock_bh(&card->mclock); |
| |
| hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } |
| |
| spin_unlock_bh(&card->mclock); |
| |
| |
| } |
| static void qeth_l3_recover_ip(struct qeth_card *card) |
| { |
| struct qeth_ipaddr *addr; |
| struct hlist_node *tmp; |
| int i; |
| int rc; |
| |
| QETH_CARD_TEXT(card, 4, "recovrip"); |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) { |
| if (addr->disp_flag == QETH_DISP_ADDR_DELETE) { |
| qeth_l3_deregister_addr_entry(card, addr); |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } else if (addr->disp_flag == QETH_DISP_ADDR_ADD) { |
| if (addr->proto == QETH_PROT_IPV4) { |
| addr->in_progress = 1; |
| spin_unlock_bh(&card->ip_lock); |
| rc = qeth_l3_register_addr_entry(card, addr); |
| spin_lock_bh(&card->ip_lock); |
| addr->in_progress = 0; |
| } else |
| rc = qeth_l3_register_addr_entry(card, addr); |
| |
| if (!rc) { |
| addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING; |
| if (addr->ref_counter < 1) |
| qeth_l3_delete_ip(card, addr); |
| } else { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } |
| } |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| } |
| |
| static int qeth_l3_send_setdelmc(struct qeth_card *card, |
| struct qeth_ipaddr *addr, int ipacmd) |
| { |
| int rc; |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| |
| QETH_CARD_TEXT(card, 4, "setdelmc"); |
| |
| iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| memcpy(&cmd->data.setdelipm.mac, addr->mac, OSA_ADDR_LEN); |
| if (addr->proto == QETH_PROT_IPV6) |
| memcpy(cmd->data.setdelipm.ip6, &addr->u.a6.addr, |
| sizeof(struct in6_addr)); |
| else |
| memcpy(&cmd->data.setdelipm.ip4, &addr->u.a4.addr, 4); |
| |
| rc = qeth_send_ipa_cmd(card, iob, NULL, NULL); |
| |
| return rc; |
| } |
| |
| static void qeth_l3_fill_netmask(u8 *netmask, unsigned int len) |
| { |
| int i, j; |
| for (i = 0; i < 16; i++) { |
| j = (len) - (i * 8); |
| if (j >= 8) |
| netmask[i] = 0xff; |
| else if (j > 0) |
| netmask[i] = (u8)(0xFF00 >> j); |
| else |
| netmask[i] = 0; |
| } |
| } |
| |
| static int qeth_l3_send_setdelip(struct qeth_card *card, |
| struct qeth_ipaddr *addr, int ipacmd, unsigned int flags) |
| { |
| int rc; |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| __u8 netmask[16]; |
| |
| QETH_CARD_TEXT(card, 4, "setdelip"); |
| QETH_CARD_TEXT_(card, 4, "flags%02X", flags); |
| |
| iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| if (addr->proto == QETH_PROT_IPV6) { |
| memcpy(cmd->data.setdelip6.ip_addr, &addr->u.a6.addr, |
| sizeof(struct in6_addr)); |
| qeth_l3_fill_netmask(netmask, addr->u.a6.pfxlen); |
| memcpy(cmd->data.setdelip6.mask, netmask, |
| sizeof(struct in6_addr)); |
| cmd->data.setdelip6.flags = flags; |
| } else { |
| memcpy(cmd->data.setdelip4.ip_addr, &addr->u.a4.addr, 4); |
| memcpy(cmd->data.setdelip4.mask, &addr->u.a4.mask, 4); |
| cmd->data.setdelip4.flags = flags; |
| } |
| |
| rc = qeth_send_ipa_cmd(card, iob, NULL, NULL); |
| |
| return rc; |
| } |
| |
| static int qeth_l3_send_setrouting(struct qeth_card *card, |
| enum qeth_routing_types type, enum qeth_prot_versions prot) |
| { |
| int rc; |
| struct qeth_ipa_cmd *cmd; |
| struct qeth_cmd_buffer *iob; |
| |
| QETH_CARD_TEXT(card, 4, "setroutg"); |
| iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETRTG, prot); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| cmd->data.setrtg.type = (type); |
| rc = qeth_send_ipa_cmd(card, iob, NULL, NULL); |
| |
| return rc; |
| } |
| |
| static int qeth_l3_correct_routing_type(struct qeth_card *card, |
| enum qeth_routing_types *type, enum qeth_prot_versions prot) |
| { |
| if (card->info.type == QETH_CARD_TYPE_IQD) { |
| switch (*type) { |
| case NO_ROUTER: |
| case PRIMARY_CONNECTOR: |
| case SECONDARY_CONNECTOR: |
| case MULTICAST_ROUTER: |
| return 0; |
| default: |
| goto out_inval; |
| } |
| } else { |
| switch (*type) { |
| case NO_ROUTER: |
| case PRIMARY_ROUTER: |
| case SECONDARY_ROUTER: |
| return 0; |
| case MULTICAST_ROUTER: |
| if (qeth_is_ipafunc_supported(card, prot, |
| IPA_OSA_MC_ROUTER)) |
| return 0; |
| default: |
| goto out_inval; |
| } |
| } |
| out_inval: |
| *type = NO_ROUTER; |
| return -EINVAL; |
| } |
| |
| int qeth_l3_setrouting_v4(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "setrtg4"); |
| |
| rc = qeth_l3_correct_routing_type(card, &card->options.route4.type, |
| QETH_PROT_IPV4); |
| if (rc) |
| return rc; |
| |
| rc = qeth_l3_send_setrouting(card, card->options.route4.type, |
| QETH_PROT_IPV4); |
| if (rc) { |
| card->options.route4.type = NO_ROUTER; |
| QETH_DBF_MESSAGE(2, "Error (0x%04x) while setting routing type" |
| " on %s. Type set to 'no router'.\n", rc, |
| QETH_CARD_IFNAME(card)); |
| } |
| return rc; |
| } |
| |
| int qeth_l3_setrouting_v6(struct qeth_card *card) |
| { |
| int rc = 0; |
| |
| QETH_CARD_TEXT(card, 3, "setrtg6"); |
| #ifdef CONFIG_QETH_IPV6 |
| |
| if (!qeth_is_supported(card, IPA_IPV6)) |
| return 0; |
| rc = qeth_l3_correct_routing_type(card, &card->options.route6.type, |
| QETH_PROT_IPV6); |
| if (rc) |
| return rc; |
| |
| rc = qeth_l3_send_setrouting(card, card->options.route6.type, |
| QETH_PROT_IPV6); |
| if (rc) { |
| card->options.route6.type = NO_ROUTER; |
| QETH_DBF_MESSAGE(2, "Error (0x%04x) while setting routing type" |
| " on %s. Type set to 'no router'.\n", rc, |
| QETH_CARD_IFNAME(card)); |
| } |
| #endif |
| return rc; |
| } |
| |
| /* |
| * IP address takeover related functions |
| */ |
| static void qeth_l3_clear_ipato_list(struct qeth_card *card) |
| { |
| struct qeth_ipato_entry *ipatoe, *tmp; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) { |
| list_del(&ipatoe->entry); |
| kfree(ipatoe); |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| } |
| |
| int qeth_l3_add_ipato_entry(struct qeth_card *card, |
| struct qeth_ipato_entry *new) |
| { |
| struct qeth_ipato_entry *ipatoe; |
| int rc = 0; |
| |
| QETH_CARD_TEXT(card, 2, "addipato"); |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| list_for_each_entry(ipatoe, &card->ipato.entries, entry) { |
| if (ipatoe->proto != new->proto) |
| continue; |
| if (!memcmp(ipatoe->addr, new->addr, |
| (ipatoe->proto == QETH_PROT_IPV4)? 4:16) && |
| (ipatoe->mask_bits == new->mask_bits)) { |
| rc = -EEXIST; |
| break; |
| } |
| } |
| |
| if (!rc) |
| list_add_tail(&new->entry, &card->ipato.entries); |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| return rc; |
| } |
| |
| void qeth_l3_del_ipato_entry(struct qeth_card *card, |
| enum qeth_prot_versions proto, u8 *addr, int mask_bits) |
| { |
| struct qeth_ipato_entry *ipatoe, *tmp; |
| |
| QETH_CARD_TEXT(card, 2, "delipato"); |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) { |
| if (ipatoe->proto != proto) |
| continue; |
| if (!memcmp(ipatoe->addr, addr, |
| (proto == QETH_PROT_IPV4)? 4:16) && |
| (ipatoe->mask_bits == mask_bits)) { |
| list_del(&ipatoe->entry); |
| kfree(ipatoe); |
| } |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| } |
| |
| /* |
| * VIPA related functions |
| */ |
| int qeth_l3_add_vipa(struct qeth_card *card, enum qeth_prot_versions proto, |
| const u8 *addr) |
| { |
| struct qeth_ipaddr *ipaddr; |
| int rc = 0; |
| |
| ipaddr = qeth_l3_get_addr_buffer(proto); |
| if (ipaddr) { |
| if (proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "addvipa4"); |
| memcpy(&ipaddr->u.a4.addr, addr, 4); |
| ipaddr->u.a4.mask = 0; |
| } else if (proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "addvipa6"); |
| memcpy(&ipaddr->u.a6.addr, addr, 16); |
| ipaddr->u.a6.pfxlen = 0; |
| } |
| ipaddr->type = QETH_IP_TYPE_VIPA; |
| ipaddr->set_flags = QETH_IPA_SETIP_VIPA_FLAG; |
| ipaddr->del_flags = QETH_IPA_DELIP_VIPA_FLAG; |
| } else |
| return -ENOMEM; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| if (qeth_l3_ip_from_hash(card, ipaddr)) |
| rc = -EEXIST; |
| else |
| qeth_l3_add_ip(card, ipaddr); |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(ipaddr); |
| |
| return rc; |
| } |
| |
| void qeth_l3_del_vipa(struct qeth_card *card, enum qeth_prot_versions proto, |
| const u8 *addr) |
| { |
| struct qeth_ipaddr *ipaddr; |
| |
| ipaddr = qeth_l3_get_addr_buffer(proto); |
| if (ipaddr) { |
| if (proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "delvipa4"); |
| memcpy(&ipaddr->u.a4.addr, addr, 4); |
| ipaddr->u.a4.mask = 0; |
| } else if (proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "delvipa6"); |
| memcpy(&ipaddr->u.a6.addr, addr, 16); |
| ipaddr->u.a6.pfxlen = 0; |
| } |
| ipaddr->type = QETH_IP_TYPE_VIPA; |
| } else |
| return; |
| |
| spin_lock_bh(&card->ip_lock); |
| qeth_l3_delete_ip(card, ipaddr); |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(ipaddr); |
| } |
| |
| /* |
| * proxy ARP related functions |
| */ |
| int qeth_l3_add_rxip(struct qeth_card *card, enum qeth_prot_versions proto, |
| const u8 *addr) |
| { |
| struct qeth_ipaddr *ipaddr; |
| int rc = 0; |
| |
| ipaddr = qeth_l3_get_addr_buffer(proto); |
| if (ipaddr) { |
| if (proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "addrxip4"); |
| memcpy(&ipaddr->u.a4.addr, addr, 4); |
| ipaddr->u.a4.mask = 0; |
| } else if (proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "addrxip6"); |
| memcpy(&ipaddr->u.a6.addr, addr, 16); |
| ipaddr->u.a6.pfxlen = 0; |
| } |
| |
| ipaddr->type = QETH_IP_TYPE_RXIP; |
| ipaddr->set_flags = QETH_IPA_SETIP_TAKEOVER_FLAG; |
| ipaddr->del_flags = 0; |
| } else |
| return -ENOMEM; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| if (qeth_l3_ip_from_hash(card, ipaddr)) |
| rc = -EEXIST; |
| else |
| qeth_l3_add_ip(card, ipaddr); |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(ipaddr); |
| |
| return rc; |
| } |
| |
| void qeth_l3_del_rxip(struct qeth_card *card, enum qeth_prot_versions proto, |
| const u8 *addr) |
| { |
| struct qeth_ipaddr *ipaddr; |
| |
| ipaddr = qeth_l3_get_addr_buffer(proto); |
| if (ipaddr) { |
| if (proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "delrxip4"); |
| memcpy(&ipaddr->u.a4.addr, addr, 4); |
| ipaddr->u.a4.mask = 0; |
| } else if (proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "delrxip6"); |
| memcpy(&ipaddr->u.a6.addr, addr, 16); |
| ipaddr->u.a6.pfxlen = 0; |
| } |
| ipaddr->type = QETH_IP_TYPE_RXIP; |
| } else |
| return; |
| |
| spin_lock_bh(&card->ip_lock); |
| qeth_l3_delete_ip(card, ipaddr); |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(ipaddr); |
| } |
| |
| static int qeth_l3_register_addr_entry(struct qeth_card *card, |
| struct qeth_ipaddr *addr) |
| { |
| char buf[50]; |
| int rc = 0; |
| int cnt = 3; |
| |
| |
| if (addr->proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "setaddr4"); |
| QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int)); |
| } else if (addr->proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "setaddr6"); |
| QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8); |
| QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8); |
| } else { |
| QETH_CARD_TEXT(card, 2, "setaddr?"); |
| QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr)); |
| } |
| do { |
| if (addr->is_multicast) |
| rc = qeth_l3_send_setdelmc(card, addr, IPA_CMD_SETIPM); |
| else |
| rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_SETIP, |
| addr->set_flags); |
| if (rc) |
| QETH_CARD_TEXT(card, 2, "failed"); |
| } while ((--cnt > 0) && rc); |
| if (rc) { |
| QETH_CARD_TEXT(card, 2, "FAILED"); |
| qeth_l3_ipaddr_to_string(addr->proto, (u8 *)&addr->u, buf); |
| dev_warn(&card->gdev->dev, |
| "Registering IP address %s failed\n", buf); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_deregister_addr_entry(struct qeth_card *card, |
| struct qeth_ipaddr *addr) |
| { |
| int rc = 0; |
| |
| if (addr->proto == QETH_PROT_IPV4) { |
| QETH_CARD_TEXT(card, 2, "deladdr4"); |
| QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int)); |
| } else if (addr->proto == QETH_PROT_IPV6) { |
| QETH_CARD_TEXT(card, 2, "deladdr6"); |
| QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8); |
| QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8); |
| } else { |
| QETH_CARD_TEXT(card, 2, "deladdr?"); |
| QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr)); |
| } |
| if (addr->is_multicast) |
| rc = qeth_l3_send_setdelmc(card, addr, IPA_CMD_DELIPM); |
| else |
| rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_DELIP, |
| addr->del_flags); |
| if (rc) |
| QETH_CARD_TEXT(card, 2, "failed"); |
| |
| return rc; |
| } |
| |
| static u8 qeth_l3_get_qeth_hdr_flags4(int cast_type) |
| { |
| if (cast_type == RTN_MULTICAST) |
| return QETH_CAST_MULTICAST; |
| if (cast_type == RTN_BROADCAST) |
| return QETH_CAST_BROADCAST; |
| return QETH_CAST_UNICAST; |
| } |
| |
| static u8 qeth_l3_get_qeth_hdr_flags6(int cast_type) |
| { |
| u8 ct = QETH_HDR_PASSTHRU | QETH_HDR_IPV6; |
| if (cast_type == RTN_MULTICAST) |
| return ct | QETH_CAST_MULTICAST; |
| if (cast_type == RTN_ANYCAST) |
| return ct | QETH_CAST_ANYCAST; |
| if (cast_type == RTN_BROADCAST) |
| return ct | QETH_CAST_BROADCAST; |
| return ct | QETH_CAST_UNICAST; |
| } |
| |
| static int qeth_l3_setadapter_parms(struct qeth_card *card) |
| { |
| int rc = 0; |
| |
| QETH_DBF_TEXT(SETUP, 2, "setadprm"); |
| |
| if (qeth_adp_supported(card, IPA_SETADP_ALTER_MAC_ADDRESS)) { |
| rc = qeth_setadpparms_change_macaddr(card); |
| if (rc) |
| dev_warn(&card->gdev->dev, "Reading the adapter MAC" |
| " address failed\n"); |
| } |
| |
| return rc; |
| } |
| |
| #ifdef CONFIG_QETH_IPV6 |
| static int qeth_l3_send_simple_setassparms_ipv6(struct qeth_card *card, |
| enum qeth_ipa_funcs ipa_func, __u16 cmd_code) |
| { |
| int rc; |
| struct qeth_cmd_buffer *iob; |
| |
| QETH_CARD_TEXT(card, 4, "simassp6"); |
| iob = qeth_get_setassparms_cmd(card, ipa_func, cmd_code, |
| 0, QETH_PROT_IPV6); |
| if (!iob) |
| return -ENOMEM; |
| rc = qeth_send_setassparms(card, iob, 0, 0, |
| qeth_setassparms_cb, NULL); |
| return rc; |
| } |
| #endif |
| |
| static int qeth_l3_start_ipa_arp_processing(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "ipaarp"); |
| |
| if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) { |
| dev_info(&card->gdev->dev, |
| "ARP processing not supported on %s!\n", |
| QETH_CARD_IFNAME(card)); |
| return 0; |
| } |
| rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_START, 0); |
| if (rc) { |
| dev_warn(&card->gdev->dev, |
| "Starting ARP processing support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_start_ipa_source_mac(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "stsrcmac"); |
| |
| if (!qeth_is_supported(card, IPA_SOURCE_MAC)) { |
| dev_info(&card->gdev->dev, |
| "Inbound source MAC-address not supported on %s\n", |
| QETH_CARD_IFNAME(card)); |
| return -EOPNOTSUPP; |
| } |
| |
| rc = qeth_send_simple_setassparms(card, IPA_SOURCE_MAC, |
| IPA_CMD_ASS_START, 0); |
| if (rc) |
| dev_warn(&card->gdev->dev, |
| "Starting source MAC-address support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| return rc; |
| } |
| |
| static int qeth_l3_start_ipa_vlan(struct qeth_card *card) |
| { |
| int rc = 0; |
| |
| QETH_CARD_TEXT(card, 3, "strtvlan"); |
| |
| if (!qeth_is_supported(card, IPA_FULL_VLAN)) { |
| dev_info(&card->gdev->dev, |
| "VLAN not supported on %s\n", QETH_CARD_IFNAME(card)); |
| return -EOPNOTSUPP; |
| } |
| |
| rc = qeth_send_simple_setassparms(card, IPA_VLAN_PRIO, |
| IPA_CMD_ASS_START, 0); |
| if (rc) { |
| dev_warn(&card->gdev->dev, |
| "Starting VLAN support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| } else { |
| dev_info(&card->gdev->dev, "VLAN enabled\n"); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_start_ipa_multicast(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "stmcast"); |
| |
| if (!qeth_is_supported(card, IPA_MULTICASTING)) { |
| dev_info(&card->gdev->dev, |
| "Multicast not supported on %s\n", |
| QETH_CARD_IFNAME(card)); |
| return -EOPNOTSUPP; |
| } |
| |
| rc = qeth_send_simple_setassparms(card, IPA_MULTICASTING, |
| IPA_CMD_ASS_START, 0); |
| if (rc) { |
| dev_warn(&card->gdev->dev, |
| "Starting multicast support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| } else { |
| dev_info(&card->gdev->dev, "Multicast enabled\n"); |
| card->dev->flags |= IFF_MULTICAST; |
| } |
| return rc; |
| } |
| |
| #ifdef CONFIG_QETH_IPV6 |
| static int qeth_l3_softsetup_ipv6(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "softipv6"); |
| |
| rc = qeth_query_ipassists(card, QETH_PROT_IPV6); |
| if (rc) { |
| dev_err(&card->gdev->dev, |
| "Activating IPv6 support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| return rc; |
| } |
| |
| if (card->info.type == QETH_CARD_TYPE_IQD) |
| goto out; |
| |
| rc = qeth_send_simple_setassparms(card, IPA_IPV6, |
| IPA_CMD_ASS_START, 3); |
| if (rc) { |
| dev_err(&card->gdev->dev, |
| "Activating IPv6 support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| return rc; |
| } |
| rc = qeth_l3_send_simple_setassparms_ipv6(card, IPA_IPV6, |
| IPA_CMD_ASS_START); |
| if (rc) { |
| dev_err(&card->gdev->dev, |
| "Activating IPv6 support for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| return rc; |
| } |
| rc = qeth_l3_send_simple_setassparms_ipv6(card, IPA_PASSTHRU, |
| IPA_CMD_ASS_START); |
| if (rc) { |
| dev_warn(&card->gdev->dev, |
| "Enabling the passthrough mode for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| return rc; |
| } |
| out: |
| dev_info(&card->gdev->dev, "IPV6 enabled\n"); |
| return 0; |
| } |
| #endif |
| |
| static int qeth_l3_start_ipa_ipv6(struct qeth_card *card) |
| { |
| int rc = 0; |
| |
| QETH_CARD_TEXT(card, 3, "strtipv6"); |
| |
| if (!qeth_is_supported(card, IPA_IPV6)) { |
| dev_info(&card->gdev->dev, |
| "IPv6 not supported on %s\n", QETH_CARD_IFNAME(card)); |
| return 0; |
| } |
| #ifdef CONFIG_QETH_IPV6 |
| rc = qeth_l3_softsetup_ipv6(card); |
| #endif |
| return rc ; |
| } |
| |
| static int qeth_l3_start_ipa_broadcast(struct qeth_card *card) |
| { |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "stbrdcst"); |
| card->info.broadcast_capable = 0; |
| if (!qeth_is_supported(card, IPA_FILTERING)) { |
| dev_info(&card->gdev->dev, |
| "Broadcast not supported on %s\n", |
| QETH_CARD_IFNAME(card)); |
| rc = -EOPNOTSUPP; |
| goto out; |
| } |
| rc = qeth_send_simple_setassparms(card, IPA_FILTERING, |
| IPA_CMD_ASS_START, 0); |
| if (rc) { |
| dev_warn(&card->gdev->dev, "Enabling broadcast filtering for " |
| "%s failed\n", QETH_CARD_IFNAME(card)); |
| goto out; |
| } |
| |
| rc = qeth_send_simple_setassparms(card, IPA_FILTERING, |
| IPA_CMD_ASS_CONFIGURE, 1); |
| if (rc) { |
| dev_warn(&card->gdev->dev, |
| "Setting up broadcast filtering for %s failed\n", |
| QETH_CARD_IFNAME(card)); |
| goto out; |
| } |
| card->info.broadcast_capable = QETH_BROADCAST_WITH_ECHO; |
| dev_info(&card->gdev->dev, "Broadcast enabled\n"); |
| rc = qeth_send_simple_setassparms(card, IPA_FILTERING, |
| IPA_CMD_ASS_ENABLE, 1); |
| if (rc) { |
| dev_warn(&card->gdev->dev, "Setting up broadcast echo " |
| "filtering for %s failed\n", QETH_CARD_IFNAME(card)); |
| goto out; |
| } |
| card->info.broadcast_capable = QETH_BROADCAST_WITHOUT_ECHO; |
| out: |
| if (card->info.broadcast_capable) |
| card->dev->flags |= IFF_BROADCAST; |
| else |
| card->dev->flags &= ~IFF_BROADCAST; |
| return rc; |
| } |
| |
| static int qeth_l3_start_ipassists(struct qeth_card *card) |
| { |
| QETH_CARD_TEXT(card, 3, "strtipas"); |
| |
| if (qeth_set_access_ctrl_online(card, 0)) |
| return -EIO; |
| qeth_l3_start_ipa_arp_processing(card); /* go on*/ |
| qeth_l3_start_ipa_source_mac(card); /* go on*/ |
| qeth_l3_start_ipa_vlan(card); /* go on*/ |
| qeth_l3_start_ipa_multicast(card); /* go on*/ |
| qeth_l3_start_ipa_ipv6(card); /* go on*/ |
| qeth_l3_start_ipa_broadcast(card); /* go on*/ |
| return 0; |
| } |
| |
| static int qeth_l3_iqd_read_initial_mac_cb(struct qeth_card *card, |
| struct qeth_reply *reply, unsigned long data) |
| { |
| struct qeth_ipa_cmd *cmd; |
| |
| cmd = (struct qeth_ipa_cmd *) data; |
| if (cmd->hdr.return_code == 0) |
| memcpy(card->dev->dev_addr, |
| cmd->data.create_destroy_addr.unique_id, ETH_ALEN); |
| else |
| eth_random_addr(card->dev->dev_addr); |
| |
| return 0; |
| } |
| |
| static int qeth_l3_iqd_read_initial_mac(struct qeth_card *card) |
| { |
| int rc = 0; |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| |
| QETH_DBF_TEXT(SETUP, 2, "hsrmac"); |
| |
| iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR, |
| QETH_PROT_IPV6); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| *((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) = |
| card->info.unique_id; |
| |
| rc = qeth_send_ipa_cmd(card, iob, qeth_l3_iqd_read_initial_mac_cb, |
| NULL); |
| return rc; |
| } |
| |
| static int qeth_l3_get_unique_id_cb(struct qeth_card *card, |
| struct qeth_reply *reply, unsigned long data) |
| { |
| struct qeth_ipa_cmd *cmd; |
| |
| cmd = (struct qeth_ipa_cmd *) data; |
| if (cmd->hdr.return_code == 0) |
| card->info.unique_id = *((__u16 *) |
| &cmd->data.create_destroy_addr.unique_id[6]); |
| else { |
| card->info.unique_id = UNIQUE_ID_IF_CREATE_ADDR_FAILED | |
| UNIQUE_ID_NOT_BY_CARD; |
| dev_warn(&card->gdev->dev, "The network adapter failed to " |
| "generate a unique ID\n"); |
| } |
| return 0; |
| } |
| |
| static int qeth_l3_get_unique_id(struct qeth_card *card) |
| { |
| int rc = 0; |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| |
| QETH_DBF_TEXT(SETUP, 2, "guniqeid"); |
| |
| if (!qeth_is_supported(card, IPA_IPV6)) { |
| card->info.unique_id = UNIQUE_ID_IF_CREATE_ADDR_FAILED | |
| UNIQUE_ID_NOT_BY_CARD; |
| return 0; |
| } |
| |
| iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR, |
| QETH_PROT_IPV6); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| *((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) = |
| card->info.unique_id; |
| |
| rc = qeth_send_ipa_cmd(card, iob, qeth_l3_get_unique_id_cb, NULL); |
| return rc; |
| } |
| |
| static int |
| qeth_diags_trace_cb(struct qeth_card *card, struct qeth_reply *reply, |
| unsigned long data) |
| { |
| struct qeth_ipa_cmd *cmd; |
| __u16 rc; |
| |
| QETH_DBF_TEXT(SETUP, 2, "diastrcb"); |
| |
| cmd = (struct qeth_ipa_cmd *)data; |
| rc = cmd->hdr.return_code; |
| if (rc) |
| QETH_CARD_TEXT_(card, 2, "dxter%x", rc); |
| switch (cmd->data.diagass.action) { |
| case QETH_DIAGS_CMD_TRACE_QUERY: |
| break; |
| case QETH_DIAGS_CMD_TRACE_DISABLE: |
| switch (rc) { |
| case 0: |
| case IPA_RC_INVALID_SUBCMD: |
| card->info.promisc_mode = SET_PROMISC_MODE_OFF; |
| dev_info(&card->gdev->dev, "The HiperSockets network " |
| "traffic analyzer is deactivated\n"); |
| break; |
| default: |
| break; |
| } |
| break; |
| case QETH_DIAGS_CMD_TRACE_ENABLE: |
| switch (rc) { |
| case 0: |
| card->info.promisc_mode = SET_PROMISC_MODE_ON; |
| dev_info(&card->gdev->dev, "The HiperSockets network " |
| "traffic analyzer is activated\n"); |
| break; |
| case IPA_RC_HARDWARE_AUTH_ERROR: |
| dev_warn(&card->gdev->dev, "The device is not " |
| "authorized to run as a HiperSockets network " |
| "traffic analyzer\n"); |
| break; |
| case IPA_RC_TRACE_ALREADY_ACTIVE: |
| dev_warn(&card->gdev->dev, "A HiperSockets " |
| "network traffic analyzer is already " |
| "active in the HiperSockets LAN\n"); |
| break; |
| default: |
| break; |
| } |
| break; |
| default: |
| QETH_DBF_MESSAGE(2, "Unknown sniffer action (0x%04x) on %s\n", |
| cmd->data.diagass.action, QETH_CARD_IFNAME(card)); |
| } |
| |
| return 0; |
| } |
| |
| static int |
| qeth_diags_trace(struct qeth_card *card, enum qeth_diags_trace_cmds diags_cmd) |
| { |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| |
| QETH_DBF_TEXT(SETUP, 2, "diagtrac"); |
| |
| iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SET_DIAG_ASS, 0); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| cmd->data.diagass.subcmd_len = 16; |
| cmd->data.diagass.subcmd = QETH_DIAGS_CMD_TRACE; |
| cmd->data.diagass.type = QETH_DIAGS_TYPE_HIPERSOCKET; |
| cmd->data.diagass.action = diags_cmd; |
| return qeth_send_ipa_cmd(card, iob, qeth_diags_trace_cb, NULL); |
| } |
| |
| static void qeth_l3_get_mac_for_ipm(__be32 ipm, char *mac) |
| { |
| ip_eth_mc_map(ipm, mac); |
| } |
| |
| static void qeth_l3_mark_all_mc_to_be_deleted(struct qeth_card *card) |
| { |
| struct qeth_ipaddr *addr; |
| int i; |
| |
| hash_for_each(card->ip_mc_htable, i, addr, hnode) |
| addr->disp_flag = QETH_DISP_ADDR_DELETE; |
| |
| } |
| |
| static void qeth_l3_add_all_new_mc(struct qeth_card *card) |
| { |
| struct qeth_ipaddr *addr; |
| struct hlist_node *tmp; |
| int i; |
| int rc; |
| |
| hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) { |
| if (addr->disp_flag == QETH_DISP_ADDR_ADD) { |
| rc = qeth_l3_register_addr_entry(card, addr); |
| if (!rc || (rc == IPA_RC_LAN_OFFLINE)) |
| addr->ref_counter = 1; |
| else { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } |
| } |
| } |
| |
| } |
| |
| static void qeth_l3_delete_nonused_mc(struct qeth_card *card) |
| { |
| struct qeth_ipaddr *addr; |
| struct hlist_node *tmp; |
| int i; |
| int rc; |
| |
| hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) { |
| if (addr->disp_flag == QETH_DISP_ADDR_DELETE) { |
| rc = qeth_l3_deregister_addr_entry(card, addr); |
| if (!rc || (rc == IPA_RC_MC_ADDR_NOT_FOUND)) { |
| hash_del(&addr->hnode); |
| kfree(addr); |
| } |
| } |
| } |
| |
| } |
| |
| |
| static void |
| qeth_l3_add_mc_to_hash(struct qeth_card *card, struct in_device *in4_dev) |
| { |
| struct ip_mc_list *im4; |
| struct qeth_ipaddr *tmp, *ipm; |
| char buf[MAX_ADDR_LEN]; |
| |
| QETH_CARD_TEXT(card, 4, "addmc"); |
| |
| tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV4); |
| if (!tmp) |
| return; |
| |
| for (im4 = rcu_dereference(in4_dev->mc_list); im4 != NULL; |
| im4 = rcu_dereference(im4->next_rcu)) { |
| qeth_l3_get_mac_for_ipm(im4->multiaddr, buf); |
| |
| tmp->u.a4.addr = be32_to_cpu(im4->multiaddr); |
| memcpy(tmp->mac, buf, sizeof(tmp->mac)); |
| |
| ipm = qeth_l3_ip_from_hash(card, tmp); |
| if (ipm) { |
| ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING; |
| } else { |
| ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV4); |
| if (!ipm) |
| continue; |
| memcpy(ipm->mac, buf, sizeof(tmp->mac)); |
| ipm->u.a4.addr = be32_to_cpu(im4->multiaddr); |
| ipm->is_multicast = 1; |
| ipm->disp_flag = QETH_DISP_ADDR_ADD; |
| hash_add(card->ip_mc_htable, |
| &ipm->hnode, qeth_l3_ipaddr_hash(ipm)); |
| } |
| } |
| |
| kfree(tmp); |
| } |
| |
| /* called with rcu_read_lock */ |
| static void qeth_l3_add_vlan_mc(struct qeth_card *card) |
| { |
| struct in_device *in_dev; |
| u16 vid; |
| |
| QETH_CARD_TEXT(card, 4, "addmcvl"); |
| |
| if (!qeth_is_supported(card, IPA_FULL_VLAN)) |
| return; |
| |
| for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) { |
| struct net_device *netdev; |
| |
| netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), |
| vid); |
| if (netdev == NULL || |
| !(netdev->flags & IFF_UP)) |
| continue; |
| in_dev = __in_dev_get_rcu(netdev); |
| if (!in_dev) |
| continue; |
| qeth_l3_add_mc_to_hash(card, in_dev); |
| } |
| } |
| |
| static void qeth_l3_add_multicast_ipv4(struct qeth_card *card) |
| { |
| struct in_device *in4_dev; |
| |
| QETH_CARD_TEXT(card, 4, "chkmcv4"); |
| |
| rcu_read_lock(); |
| in4_dev = __in_dev_get_rcu(card->dev); |
| if (in4_dev == NULL) |
| goto unlock; |
| qeth_l3_add_mc_to_hash(card, in4_dev); |
| qeth_l3_add_vlan_mc(card); |
| unlock: |
| rcu_read_unlock(); |
| } |
| |
| #ifdef CONFIG_QETH_IPV6 |
| static void |
| qeth_l3_add_mc6_to_hash(struct qeth_card *card, struct inet6_dev *in6_dev) |
| { |
| struct qeth_ipaddr *ipm; |
| struct ifmcaddr6 *im6; |
| struct qeth_ipaddr *tmp; |
| char buf[MAX_ADDR_LEN]; |
| |
| QETH_CARD_TEXT(card, 4, "addmc6"); |
| |
| tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV6); |
| if (!tmp) |
| return; |
| |
| for (im6 = in6_dev->mc_list; im6 != NULL; im6 = im6->next) { |
| ndisc_mc_map(&im6->mca_addr, buf, in6_dev->dev, 0); |
| |
| memcpy(tmp->mac, buf, sizeof(tmp->mac)); |
| memcpy(&tmp->u.a6.addr, &im6->mca_addr.s6_addr, |
| sizeof(struct in6_addr)); |
| tmp->is_multicast = 1; |
| |
| ipm = qeth_l3_ip_from_hash(card, tmp); |
| if (ipm) { |
| ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING; |
| continue; |
| } |
| |
| ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV6); |
| if (!ipm) |
| continue; |
| |
| memcpy(ipm->mac, buf, OSA_ADDR_LEN); |
| memcpy(&ipm->u.a6.addr, &im6->mca_addr.s6_addr, |
| sizeof(struct in6_addr)); |
| ipm->is_multicast = 1; |
| ipm->disp_flag = QETH_DISP_ADDR_ADD; |
| hash_add(card->ip_mc_htable, |
| &ipm->hnode, qeth_l3_ipaddr_hash(ipm)); |
| |
| } |
| kfree(tmp); |
| } |
| |
| /* called with rcu_read_lock */ |
| static void qeth_l3_add_vlan_mc6(struct qeth_card *card) |
| { |
| struct inet6_dev *in_dev; |
| u16 vid; |
| |
| QETH_CARD_TEXT(card, 4, "admc6vl"); |
| |
| if (!qeth_is_supported(card, IPA_FULL_VLAN)) |
| return; |
| |
| for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) { |
| struct net_device *netdev; |
| |
| netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), |
| vid); |
| if (netdev == NULL || |
| !(netdev->flags & IFF_UP)) |
| continue; |
| in_dev = in6_dev_get(netdev); |
| if (!in_dev) |
| continue; |
| read_lock_bh(&in_dev->lock); |
| qeth_l3_add_mc6_to_hash(card, in_dev); |
| read_unlock_bh(&in_dev->lock); |
| in6_dev_put(in_dev); |
| } |
| } |
| |
| static void qeth_l3_add_multicast_ipv6(struct qeth_card *card) |
| { |
| struct inet6_dev *in6_dev; |
| |
| QETH_CARD_TEXT(card, 4, "chkmcv6"); |
| |
| if (!qeth_is_supported(card, IPA_IPV6)) |
| return ; |
| in6_dev = in6_dev_get(card->dev); |
| if (!in6_dev) |
| return; |
| |
| rcu_read_lock(); |
| read_lock_bh(&in6_dev->lock); |
| qeth_l3_add_mc6_to_hash(card, in6_dev); |
| qeth_l3_add_vlan_mc6(card); |
| read_unlock_bh(&in6_dev->lock); |
| rcu_read_unlock(); |
| in6_dev_put(in6_dev); |
| } |
| #endif /* CONFIG_QETH_IPV6 */ |
| |
| static void qeth_l3_free_vlan_addresses4(struct qeth_card *card, |
| unsigned short vid) |
| { |
| struct in_device *in_dev; |
| struct in_ifaddr *ifa; |
| struct qeth_ipaddr *addr; |
| struct net_device *netdev; |
| |
| QETH_CARD_TEXT(card, 4, "frvaddr4"); |
| |
| netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), vid); |
| if (!netdev) |
| return; |
| in_dev = in_dev_get(netdev); |
| if (!in_dev) |
| return; |
| |
| addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV4); |
| if (!addr) |
| return; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| for (ifa = in_dev->ifa_list; ifa; ifa = ifa->ifa_next) { |
| addr->u.a4.addr = be32_to_cpu(ifa->ifa_address); |
| addr->u.a4.mask = be32_to_cpu(ifa->ifa_mask); |
| addr->type = QETH_IP_TYPE_NORMAL; |
| qeth_l3_delete_ip(card, addr); |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(addr); |
| in_dev_put(in_dev); |
| } |
| |
| static void qeth_l3_free_vlan_addresses6(struct qeth_card *card, |
| unsigned short vid) |
| { |
| #ifdef CONFIG_QETH_IPV6 |
| struct inet6_dev *in6_dev; |
| struct inet6_ifaddr *ifa; |
| struct qeth_ipaddr *addr; |
| struct net_device *netdev; |
| |
| QETH_CARD_TEXT(card, 4, "frvaddr6"); |
| |
| netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), vid); |
| if (!netdev) |
| return; |
| |
| in6_dev = in6_dev_get(netdev); |
| if (!in6_dev) |
| return; |
| |
| addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV6); |
| if (!addr) |
| return; |
| |
| spin_lock_bh(&card->ip_lock); |
| |
| list_for_each_entry(ifa, &in6_dev->addr_list, if_list) { |
| memcpy(&addr->u.a6.addr, &ifa->addr, |
| sizeof(struct in6_addr)); |
| addr->u.a6.pfxlen = ifa->prefix_len; |
| addr->type = QETH_IP_TYPE_NORMAL; |
| qeth_l3_delete_ip(card, addr); |
| } |
| |
| spin_unlock_bh(&card->ip_lock); |
| |
| kfree(addr); |
| in6_dev_put(in6_dev); |
| #endif /* CONFIG_QETH_IPV6 */ |
| } |
| |
| static void qeth_l3_free_vlan_addresses(struct qeth_card *card, |
| unsigned short vid) |
| { |
| rcu_read_lock(); |
| qeth_l3_free_vlan_addresses4(card, vid); |
| qeth_l3_free_vlan_addresses6(card, vid); |
| rcu_read_unlock(); |
| } |
| |
| static int qeth_l3_vlan_rx_add_vid(struct net_device *dev, |
| __be16 proto, u16 vid) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| |
| set_bit(vid, card->active_vlans); |
| return 0; |
| } |
| |
| static int qeth_l3_vlan_rx_kill_vid(struct net_device *dev, |
| __be16 proto, u16 vid) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| |
| QETH_CARD_TEXT_(card, 4, "kid:%d", vid); |
| |
| if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { |
| QETH_CARD_TEXT(card, 3, "kidREC"); |
| return 0; |
| } |
| /* unregister IP addresses of vlan device */ |
| qeth_l3_free_vlan_addresses(card, vid); |
| clear_bit(vid, card->active_vlans); |
| qeth_l3_set_multicast_list(card->dev); |
| return 0; |
| } |
| |
| static int qeth_l3_rebuild_skb(struct qeth_card *card, struct sk_buff *skb, |
| struct qeth_hdr *hdr, unsigned short *vlan_id) |
| { |
| __u16 prot; |
| struct iphdr *ip_hdr; |
| unsigned char tg_addr[MAX_ADDR_LEN]; |
| int is_vlan = 0; |
| |
| if (!(hdr->hdr.l3.flags & QETH_HDR_PASSTHRU)) { |
| prot = (hdr->hdr.l3.flags & QETH_HDR_IPV6) ? ETH_P_IPV6 : |
| ETH_P_IP; |
| switch (hdr->hdr.l3.flags & QETH_HDR_CAST_MASK) { |
| case QETH_CAST_MULTICAST: |
| switch (prot) { |
| #ifdef CONFIG_QETH_IPV6 |
| case ETH_P_IPV6: |
| ndisc_mc_map((struct in6_addr *) |
| skb->data + 24, |
| tg_addr, card->dev, 0); |
| break; |
| #endif |
| case ETH_P_IP: |
| ip_hdr = (struct iphdr *)skb->data; |
| ip_eth_mc_map(ip_hdr->daddr, tg_addr); |
| break; |
| default: |
| memcpy(tg_addr, card->dev->broadcast, |
| card->dev->addr_len); |
| } |
| card->stats.multicast++; |
| skb->pkt_type = PACKET_MULTICAST; |
| break; |
| case QETH_CAST_BROADCAST: |
| memcpy(tg_addr, card->dev->broadcast, |
| card->dev->addr_len); |
| card->stats.multicast++; |
| skb->pkt_type = PACKET_BROADCAST; |
| break; |
| case QETH_CAST_UNICAST: |
| case QETH_CAST_ANYCAST: |
| case QETH_CAST_NOCAST: |
| default: |
| if (card->options.sniffer) |
| skb->pkt_type = PACKET_OTHERHOST; |
| else |
| skb->pkt_type = PACKET_HOST; |
| memcpy(tg_addr, card->dev->dev_addr, |
| card->dev->addr_len); |
| } |
| if (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_SRC_MAC_ADDR) |
| card->dev->header_ops->create(skb, card->dev, prot, |
| tg_addr, &hdr->hdr.l3.dest_addr[2], |
| card->dev->addr_len); |
| else |
| card->dev->header_ops->create(skb, card->dev, prot, |
| tg_addr, "FAKELL", card->dev->addr_len); |
| } |
| |
| skb->protocol = eth_type_trans(skb, card->dev); |
| |
| if (hdr->hdr.l3.ext_flags & |
| (QETH_HDR_EXT_VLAN_FRAME | QETH_HDR_EXT_INCLUDE_VLAN_TAG)) { |
| *vlan_id = (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_VLAN_FRAME) ? |
| hdr->hdr.l3.vlan_id : *((u16 *)&hdr->hdr.l3.dest_addr[12]); |
| is_vlan = 1; |
| } |
| |
| if (card->dev->features & NETIF_F_RXCSUM) { |
| if ((hdr->hdr.l3.ext_flags & |
| (QETH_HDR_EXT_CSUM_HDR_REQ | |
| QETH_HDR_EXT_CSUM_TRANSP_REQ)) == |
| (QETH_HDR_EXT_CSUM_HDR_REQ | |
| QETH_HDR_EXT_CSUM_TRANSP_REQ)) |
| skb->ip_summed = CHECKSUM_UNNECESSARY; |
| else |
| skb->ip_summed = CHECKSUM_NONE; |
| } else |
| skb->ip_summed = CHECKSUM_NONE; |
| return is_vlan; |
| } |
| |
| static int qeth_l3_process_inbound_buffer(struct qeth_card *card, |
| int budget, int *done) |
| { |
| int work_done = 0; |
| struct sk_buff *skb; |
| struct qeth_hdr *hdr; |
| __u16 vlan_tag = 0; |
| int is_vlan; |
| unsigned int len; |
| __u16 magic; |
| |
| *done = 0; |
| WARN_ON_ONCE(!budget); |
| while (budget) { |
| skb = qeth_core_get_next_skb(card, |
| &card->qdio.in_q->bufs[card->rx.b_index], |
| &card->rx.b_element, &card->rx.e_offset, &hdr); |
| if (!skb) { |
| *done = 1; |
| break; |
| } |
| skb->dev = card->dev; |
| switch (hdr->hdr.l3.id) { |
| case QETH_HEADER_TYPE_LAYER3: |
| magic = *(__u16 *)skb->data; |
| if ((card->info.type == QETH_CARD_TYPE_IQD) && |
| (magic == ETH_P_AF_IUCV)) { |
| skb->protocol = cpu_to_be16(ETH_P_AF_IUCV); |
| skb->pkt_type = PACKET_HOST; |
| skb->mac_header = NET_SKB_PAD; |
| skb->dev = card->dev; |
| len = skb->len; |
| card->dev->header_ops->create(skb, card->dev, 0, |
| card->dev->dev_addr, "FAKELL", |
| card->dev->addr_len); |
| netif_receive_skb(skb); |
| } else { |
| is_vlan = qeth_l3_rebuild_skb(card, skb, hdr, |
| &vlan_tag); |
| len = skb->len; |
| if (is_vlan && !card->options.sniffer) |
| __vlan_hwaccel_put_tag(skb, |
| htons(ETH_P_8021Q), vlan_tag); |
| napi_gro_receive(&card->napi, skb); |
| } |
| break; |
| case QETH_HEADER_TYPE_LAYER2: /* for HiperSockets sniffer */ |
| skb->pkt_type = PACKET_HOST; |
| skb->protocol = eth_type_trans(skb, skb->dev); |
| len = skb->len; |
| netif_receive_skb(skb); |
| break; |
| default: |
| dev_kfree_skb_any(skb); |
| QETH_CARD_TEXT(card, 3, "inbunkno"); |
| QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN); |
| continue; |
| } |
| work_done++; |
| budget--; |
| card->stats.rx_packets++; |
| card->stats.rx_bytes += len; |
| } |
| return work_done; |
| } |
| |
| static int qeth_l3_verify_vlan_dev(struct net_device *dev, |
| struct qeth_card *card) |
| { |
| int rc = 0; |
| u16 vid; |
| |
| for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) { |
| struct net_device *netdev; |
| |
| rcu_read_lock(); |
| netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), |
| vid); |
| rcu_read_unlock(); |
| if (netdev == dev) { |
| rc = QETH_VLAN_CARD; |
| break; |
| } |
| } |
| |
| if (rc && !(vlan_dev_real_dev(dev)->ml_priv == (void *)card)) |
| return 0; |
| |
| return rc; |
| } |
| |
| static int qeth_l3_verify_dev(struct net_device *dev) |
| { |
| struct qeth_card *card; |
| int rc = 0; |
| unsigned long flags; |
| |
| read_lock_irqsave(&qeth_core_card_list.rwlock, flags); |
| list_for_each_entry(card, &qeth_core_card_list.list, list) { |
| if (card->dev == dev) { |
| rc = QETH_REAL_CARD; |
| break; |
| } |
| rc = qeth_l3_verify_vlan_dev(dev, card); |
| if (rc) |
| break; |
| } |
| read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags); |
| |
| return rc; |
| } |
| |
| static struct qeth_card *qeth_l3_get_card_from_dev(struct net_device *dev) |
| { |
| struct qeth_card *card = NULL; |
| int rc; |
| |
| rc = qeth_l3_verify_dev(dev); |
| if (rc == QETH_REAL_CARD) |
| card = dev->ml_priv; |
| else if (rc == QETH_VLAN_CARD) |
| card = vlan_dev_real_dev(dev)->ml_priv; |
| if (card && card->options.layer2) |
| card = NULL; |
| if (card) |
| QETH_CARD_TEXT_(card, 4, "%d", rc); |
| return card ; |
| } |
| |
| static void qeth_l3_stop_card(struct qeth_card *card, int recovery_mode) |
| { |
| QETH_DBF_TEXT(SETUP, 2, "stopcard"); |
| QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *)); |
| |
| qeth_set_allowed_threads(card, 0, 1); |
| if (card->options.sniffer && |
| (card->info.promisc_mode == SET_PROMISC_MODE_ON)) |
| qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE); |
| if (card->read.state == CH_STATE_UP && |
| card->write.state == CH_STATE_UP && |
| (card->state == CARD_STATE_UP)) { |
| if (recovery_mode) |
| qeth_l3_stop(card->dev); |
| else { |
| rtnl_lock(); |
| dev_close(card->dev); |
| rtnl_unlock(); |
| } |
| card->state = CARD_STATE_SOFTSETUP; |
| } |
| if (card->state == CARD_STATE_SOFTSETUP) { |
| qeth_l3_clear_ip_htable(card, 1); |
| qeth_clear_ipacmd_list(card); |
| card->state = CARD_STATE_HARDSETUP; |
| } |
| if (card->state == CARD_STATE_HARDSETUP) { |
| qeth_qdio_clear_card(card, 0); |
| qeth_clear_qdio_buffers(card); |
| qeth_clear_working_pool_list(card); |
| card->state = CARD_STATE_DOWN; |
| } |
| if (card->state == CARD_STATE_DOWN) { |
| qeth_clear_cmd_buffers(&card->read); |
| qeth_clear_cmd_buffers(&card->write); |
| } |
| } |
| |
| /* |
| * test for and Switch promiscuous mode (on or off) |
| * either for guestlan or HiperSocket Sniffer |
| */ |
| static void |
| qeth_l3_handle_promisc_mode(struct qeth_card *card) |
| { |
| struct net_device *dev = card->dev; |
| |
| if (((dev->flags & IFF_PROMISC) && |
| (card->info.promisc_mode == SET_PROMISC_MODE_ON)) || |
| (!(dev->flags & IFF_PROMISC) && |
| (card->info.promisc_mode == SET_PROMISC_MODE_OFF))) |
| return; |
| |
| if (card->info.guestlan) { /* Guestlan trace */ |
| if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) |
| qeth_setadp_promisc_mode(card); |
| } else if (card->options.sniffer && /* HiperSockets trace */ |
| qeth_adp_supported(card, IPA_SETADP_SET_DIAG_ASSIST)) { |
| if (dev->flags & IFF_PROMISC) { |
| QETH_CARD_TEXT(card, 3, "+promisc"); |
| qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_ENABLE); |
| } else { |
| QETH_CARD_TEXT(card, 3, "-promisc"); |
| qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE); |
| } |
| } |
| } |
| |
| static void qeth_l3_set_multicast_list(struct net_device *dev) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| |
| QETH_CARD_TEXT(card, 3, "setmulti"); |
| if (qeth_threads_running(card, QETH_RECOVER_THREAD) && |
| (card->state != CARD_STATE_UP)) |
| return; |
| if (!card->options.sniffer) { |
| |
| spin_lock_bh(&card->mclock); |
| |
| qeth_l3_mark_all_mc_to_be_deleted(card); |
| |
| qeth_l3_add_multicast_ipv4(card); |
| #ifdef CONFIG_QETH_IPV6 |
| qeth_l3_add_multicast_ipv6(card); |
| #endif |
| qeth_l3_delete_nonused_mc(card); |
| qeth_l3_add_all_new_mc(card); |
| |
| spin_unlock_bh(&card->mclock); |
| |
| if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE)) |
| return; |
| } |
| qeth_l3_handle_promisc_mode(card); |
| } |
| |
| static const char *qeth_l3_arp_get_error_cause(int *rc) |
| { |
| switch (*rc) { |
| case QETH_IPA_ARP_RC_FAILED: |
| *rc = -EIO; |
| return "operation failed"; |
| case QETH_IPA_ARP_RC_NOTSUPP: |
| *rc = -EOPNOTSUPP; |
| return "operation not supported"; |
| case QETH_IPA_ARP_RC_OUT_OF_RANGE: |
| *rc = -EINVAL; |
| return "argument out of range"; |
| case QETH_IPA_ARP_RC_Q_NOTSUPP: |
| *rc = -EOPNOTSUPP; |
| return "query operation not supported"; |
| case QETH_IPA_ARP_RC_Q_NO_DATA: |
| *rc = -ENOENT; |
| return "no query data available"; |
| default: |
| return "unknown error"; |
| } |
| } |
| |
| static int qeth_l3_arp_set_no_entries(struct qeth_card *card, int no_entries) |
| { |
| int tmp; |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "arpstnoe"); |
| |
| /* |
| * currently GuestLAN only supports the ARP assist function |
| * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_SET_NO_ENTRIES; |
| * thus we say EOPNOTSUPP for this ARP function |
| */ |
| if (card->info.guestlan) |
| return -EOPNOTSUPP; |
| if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) { |
| return -EOPNOTSUPP; |
| } |
| rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_ARP_SET_NO_ENTRIES, |
| no_entries); |
| if (rc) { |
| tmp = rc; |
| QETH_DBF_MESSAGE(2, "Could not set number of ARP entries on " |
| "%s: %s (0x%x/%d)\n", QETH_CARD_IFNAME(card), |
| qeth_l3_arp_get_error_cause(&rc), tmp, tmp); |
| } |
| return rc; |
| } |
| |
| static __u32 get_arp_entry_size(struct qeth_card *card, |
| struct qeth_arp_query_data *qdata, |
| struct qeth_arp_entrytype *type, __u8 strip_entries) |
| { |
| __u32 rc; |
| __u8 is_hsi; |
| |
| is_hsi = qdata->reply_bits == 5; |
| if (type->ip == QETHARP_IP_ADDR_V4) { |
| QETH_CARD_TEXT(card, 4, "arpev4"); |
| if (strip_entries) { |
| rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5_short) : |
| sizeof(struct qeth_arp_qi_entry7_short); |
| } else { |
| rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5) : |
| sizeof(struct qeth_arp_qi_entry7); |
| } |
| } else if (type->ip == QETHARP_IP_ADDR_V6) { |
| QETH_CARD_TEXT(card, 4, "arpev6"); |
| if (strip_entries) { |
| rc = is_hsi ? |
| sizeof(struct qeth_arp_qi_entry5_short_ipv6) : |
| sizeof(struct qeth_arp_qi_entry7_short_ipv6); |
| } else { |
| rc = is_hsi ? |
| sizeof(struct qeth_arp_qi_entry5_ipv6) : |
| sizeof(struct qeth_arp_qi_entry7_ipv6); |
| } |
| } else { |
| QETH_CARD_TEXT(card, 4, "arpinv"); |
| rc = 0; |
| } |
| |
| return rc; |
| } |
| |
| static int arpentry_matches_prot(struct qeth_arp_entrytype *type, __u16 prot) |
| { |
| return (type->ip == QETHARP_IP_ADDR_V4 && prot == QETH_PROT_IPV4) || |
| (type->ip == QETHARP_IP_ADDR_V6 && prot == QETH_PROT_IPV6); |
| } |
| |
| static int qeth_l3_arp_query_cb(struct qeth_card *card, |
| struct qeth_reply *reply, unsigned long data) |
| { |
| struct qeth_ipa_cmd *cmd; |
| struct qeth_arp_query_data *qdata; |
| struct qeth_arp_query_info *qinfo; |
| int i; |
| int e; |
| int entrybytes_done; |
| int stripped_bytes; |
| __u8 do_strip_entries; |
| |
| QETH_CARD_TEXT(card, 3, "arpquecb"); |
| |
| qinfo = (struct qeth_arp_query_info *) reply->param; |
| cmd = (struct qeth_ipa_cmd *) data; |
| QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.prot_version); |
| if (cmd->hdr.return_code) { |
| QETH_CARD_TEXT(card, 4, "arpcberr"); |
| QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code); |
| return 0; |
| } |
| if (cmd->data.setassparms.hdr.return_code) { |
| cmd->hdr.return_code = cmd->data.setassparms.hdr.return_code; |
| QETH_CARD_TEXT(card, 4, "setaperr"); |
| QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code); |
| return 0; |
| } |
| qdata = &cmd->data.setassparms.data.query_arp; |
| QETH_CARD_TEXT_(card, 4, "anoen%i", qdata->no_entries); |
| |
| do_strip_entries = (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES) > 0; |
| stripped_bytes = do_strip_entries ? QETH_QARP_MEDIASPECIFIC_BYTES : 0; |
| entrybytes_done = 0; |
| for (e = 0; e < qdata->no_entries; ++e) { |
| char *cur_entry; |
| __u32 esize; |
| struct qeth_arp_entrytype *etype; |
| |
| cur_entry = &qdata->data + entrybytes_done; |
| etype = &((struct qeth_arp_qi_entry5 *) cur_entry)->type; |
| if (!arpentry_matches_prot(etype, cmd->hdr.prot_version)) { |
| QETH_CARD_TEXT(card, 4, "pmis"); |
| QETH_CARD_TEXT_(card, 4, "%i", etype->ip); |
| break; |
| } |
| esize = get_arp_entry_size(card, qdata, etype, |
| do_strip_entries); |
| QETH_CARD_TEXT_(card, 5, "esz%i", esize); |
| if (!esize) |
| break; |
| |
| if ((qinfo->udata_len - qinfo->udata_offset) < esize) { |
| QETH_CARD_TEXT_(card, 4, "qaer3%i", -ENOMEM); |
| cmd->hdr.return_code = IPA_RC_ENOMEM; |
| goto out_error; |
| } |
| |
| memcpy(qinfo->udata + qinfo->udata_offset, |
| &qdata->data + entrybytes_done + stripped_bytes, |
| esize); |
| entrybytes_done += esize + stripped_bytes; |
| qinfo->udata_offset += esize; |
| ++qinfo->no_entries; |
| } |
| /* check if all replies received ... */ |
| if (cmd->data.setassparms.hdr.seq_no < |
| cmd->data.setassparms.hdr.number_of_replies) |
| return 1; |
| QETH_CARD_TEXT_(card, 4, "nove%i", qinfo->no_entries); |
| memcpy(qinfo->udata, &qinfo->no_entries, 4); |
| /* keep STRIP_ENTRIES flag so the user program can distinguish |
| * stripped entries from normal ones */ |
| if (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES) |
| qdata->reply_bits |= QETH_QARP_STRIP_ENTRIES; |
| memcpy(qinfo->udata + QETH_QARP_MASK_OFFSET, &qdata->reply_bits, 2); |
| QETH_CARD_TEXT_(card, 4, "rc%i", 0); |
| return 0; |
| out_error: |
| i = 0; |
| memcpy(qinfo->udata, &i, 4); |
| return 0; |
| } |
| |
| static int qeth_l3_send_ipa_arp_cmd(struct qeth_card *card, |
| struct qeth_cmd_buffer *iob, int len, |
| int (*reply_cb)(struct qeth_card *, struct qeth_reply *, |
| unsigned long), |
| void *reply_param) |
| { |
| QETH_CARD_TEXT(card, 4, "sendarp"); |
| |
| memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE); |
| memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data), |
| &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH); |
| return qeth_send_control_data(card, IPA_PDU_HEADER_SIZE + len, iob, |
| reply_cb, reply_param); |
| } |
| |
| static int qeth_l3_query_arp_cache_info(struct qeth_card *card, |
| enum qeth_prot_versions prot, |
| struct qeth_arp_query_info *qinfo) |
| { |
| struct qeth_cmd_buffer *iob; |
| struct qeth_ipa_cmd *cmd; |
| int tmp; |
| int rc; |
| |
| QETH_CARD_TEXT_(card, 3, "qarpipv%i", prot); |
| |
| iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_ARP_QUERY_INFO, |
| sizeof(struct qeth_arp_query_data) |
| - sizeof(char), |
| prot); |
| if (!iob) |
| return -ENOMEM; |
| cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE); |
| cmd->data.setassparms.data.query_arp.request_bits = 0x000F; |
| cmd->data.setassparms.data.query_arp.reply_bits = 0; |
| cmd->data.setassparms.data.query_arp.no_entries = 0; |
| rc = qeth_l3_send_ipa_arp_cmd(card, iob, |
| QETH_SETASS_BASE_LEN+QETH_ARP_CMD_LEN, |
| qeth_l3_arp_query_cb, (void *)qinfo); |
| if (rc) { |
| tmp = rc; |
| QETH_DBF_MESSAGE(2, |
| "Error while querying ARP cache on %s: %s " |
| "(0x%x/%d)\n", QETH_CARD_IFNAME(card), |
| qeth_l3_arp_get_error_cause(&rc), tmp, tmp); |
| } |
| |
| return rc; |
| } |
| |
| static int qeth_l3_arp_query(struct qeth_card *card, char __user *udata) |
| { |
| struct qeth_arp_query_info qinfo = {0, }; |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "arpquery"); |
| |
| if (!qeth_is_supported(card,/*IPA_QUERY_ARP_ADDR_INFO*/ |
| IPA_ARP_PROCESSING)) { |
| QETH_CARD_TEXT(card, 3, "arpqnsup"); |
| rc = -EOPNOTSUPP; |
| goto out; |
| } |
| /* get size of userspace buffer and mask_bits -> 6 bytes */ |
| if (copy_from_user(&qinfo, udata, 6)) { |
| rc = -EFAULT; |
| goto out; |
| } |
| qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL); |
| if (!qinfo.udata) { |
| rc = -ENOMEM; |
| goto out; |
| } |
| qinfo.udata_offset = QETH_QARP_ENTRIES_OFFSET; |
| rc = qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV4, &qinfo); |
| if (rc) { |
| if (copy_to_user(udata, qinfo.udata, 4)) |
| rc = -EFAULT; |
| goto free_and_out; |
| } |
| #ifdef CONFIG_QETH_IPV6 |
| if (qinfo.mask_bits & QETH_QARP_WITH_IPV6) { |
| /* fails in case of GuestLAN QDIO mode */ |
| qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV6, &qinfo); |
| } |
| #endif |
| if (copy_to_user(udata, qinfo.udata, qinfo.udata_len)) { |
| QETH_CARD_TEXT(card, 4, "qactf"); |
| rc = -EFAULT; |
| goto free_and_out; |
| } |
| QETH_CARD_TEXT(card, 4, "qacts"); |
| |
| free_and_out: |
| kfree(qinfo.udata); |
| out: |
| return rc; |
| } |
| |
| static int qeth_l3_arp_add_entry(struct qeth_card *card, |
| struct qeth_arp_cache_entry *entry) |
| { |
| struct qeth_cmd_buffer *iob; |
| char buf[16]; |
| int tmp; |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "arpadent"); |
| |
| /* |
| * currently GuestLAN only supports the ARP assist function |
| * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_ADD_ENTRY; |
| * thus we say EOPNOTSUPP for this ARP function |
| */ |
| if (card->info.guestlan) |
| return -EOPNOTSUPP; |
| if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) { |
| return -EOPNOTSUPP; |
| } |
| |
| iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_ARP_ADD_ENTRY, |
| sizeof(struct qeth_arp_cache_entry), |
| QETH_PROT_IPV4); |
| if (!iob) |
| return -ENOMEM; |
| rc = qeth_send_setassparms(card, iob, |
| sizeof(struct qeth_arp_cache_entry), |
| (unsigned long) entry, |
| qeth_setassparms_cb, NULL); |
| if (rc) { |
| tmp = rc; |
| qeth_l3_ipaddr4_to_string((u8 *)entry->ipaddr, buf); |
| QETH_DBF_MESSAGE(2, "Could not add ARP entry for address %s " |
| "on %s: %s (0x%x/%d)\n", buf, QETH_CARD_IFNAME(card), |
| qeth_l3_arp_get_error_cause(&rc), tmp, tmp); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_arp_remove_entry(struct qeth_card *card, |
| struct qeth_arp_cache_entry *entry) |
| { |
| struct qeth_cmd_buffer *iob; |
| char buf[16] = {0, }; |
| int tmp; |
| int rc; |
| |
| QETH_CARD_TEXT(card, 3, "arprment"); |
| |
| /* |
| * currently GuestLAN only supports the ARP assist function |
| * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_REMOVE_ENTRY; |
| * thus we say EOPNOTSUPP for this ARP function |
| */ |
| if (card->info.guestlan) |
| return -EOPNOTSUPP; |
| if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) { |
| return -EOPNOTSUPP; |
| } |
| memcpy(buf, entry, 12); |
| iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_ARP_REMOVE_ENTRY, |
| 12, |
| QETH_PROT_IPV4); |
| if (!iob) |
| return -ENOMEM; |
| rc = qeth_send_setassparms(card, iob, |
| 12, (unsigned long)buf, |
| qeth_setassparms_cb, NULL); |
| if (rc) { |
| tmp = rc; |
| memset(buf, 0, 16); |
| qeth_l3_ipaddr4_to_string((u8 *)entry->ipaddr, buf); |
| QETH_DBF_MESSAGE(2, "Could not delete ARP entry for address %s" |
| " on %s: %s (0x%x/%d)\n", buf, QETH_CARD_IFNAME(card), |
| qeth_l3_arp_get_error_cause(&rc), tmp, tmp); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_arp_flush_cache(struct qeth_card *card) |
| { |
| int rc; |
| int tmp; |
| |
| QETH_CARD_TEXT(card, 3, "arpflush"); |
| |
| /* |
| * currently GuestLAN only supports the ARP assist function |
| * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_FLUSH_CACHE; |
| * thus we say EOPNOTSUPP for this ARP function |
| */ |
| if (card->info.guestlan || (card->info.type == QETH_CARD_TYPE_IQD)) |
| return -EOPNOTSUPP; |
| if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) { |
| return -EOPNOTSUPP; |
| } |
| rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING, |
| IPA_CMD_ASS_ARP_FLUSH_CACHE, 0); |
| if (rc) { |
| tmp = rc; |
| QETH_DBF_MESSAGE(2, "Could not flush ARP cache on %s: %s " |
| "(0x%x/%d)\n", QETH_CARD_IFNAME(card), |
| qeth_l3_arp_get_error_cause(&rc), tmp, tmp); |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| struct qeth_arp_cache_entry arp_entry; |
| int rc = 0; |
| |
| switch (cmd) { |
| case SIOC_QETH_ARP_SET_NO_ENTRIES: |
| if (!capable(CAP_NET_ADMIN)) { |
| rc = -EPERM; |
| break; |
| } |
| rc = qeth_l3_arp_set_no_entries(card, rq->ifr_ifru.ifru_ivalue); |
| break; |
| case SIOC_QETH_ARP_QUERY_INFO: |
| if (!capable(CAP_NET_ADMIN)) { |
| rc = -EPERM; |
| break; |
| } |
| rc = qeth_l3_arp_query(card, rq->ifr_ifru.ifru_data); |
| break; |
| case SIOC_QETH_ARP_ADD_ENTRY: |
| if (!capable(CAP_NET_ADMIN)) { |
| rc = -EPERM; |
| break; |
| } |
| if (copy_from_user(&arp_entry, rq->ifr_ifru.ifru_data, |
| sizeof(struct qeth_arp_cache_entry))) |
| rc = -EFAULT; |
| else |
| rc = qeth_l3_arp_add_entry(card, &arp_entry); |
| break; |
| case SIOC_QETH_ARP_REMOVE_ENTRY: |
| if (!capable(CAP_NET_ADMIN)) { |
| rc = -EPERM; |
| break; |
| } |
| if (copy_from_user(&arp_entry, rq->ifr_ifru.ifru_data, |
| sizeof(struct qeth_arp_cache_entry))) |
| rc = -EFAULT; |
| else |
| rc = qeth_l3_arp_remove_entry(card, &arp_entry); |
| break; |
| case SIOC_QETH_ARP_FLUSH_CACHE: |
| if (!capable(CAP_NET_ADMIN)) { |
| rc = -EPERM; |
| break; |
| } |
| rc = qeth_l3_arp_flush_cache(card); |
| break; |
| default: |
| rc = -EOPNOTSUPP; |
| } |
| return rc; |
| } |
| |
| static int qeth_l3_get_cast_type(struct qeth_card *card, struct sk_buff *skb) |
| { |
| int cast_type = RTN_UNSPEC; |
| struct neighbour *n = NULL; |
| struct dst_entry *dst; |
| |
| rcu_read_lock(); |
| dst = skb_dst(skb); |
| if (dst) |
| n = dst_neigh_lookup_skb(dst, skb); |
| if (n) { |
| cast_type = n->type; |
| rcu_read_unlock(); |
| neigh_release(n); |
| if ((cast_type == RTN_BROADCAST) || |
| (cast_type == RTN_MULTICAST) || |
| (cast_type == RTN_ANYCAST)) |
| return cast_type; |
| else |
| return RTN_UNSPEC; |
| } |
| rcu_read_unlock(); |
| |
| /* try something else */ |
| if (be16_to_cpu(skb->protocol) == ETH_P_IPV6) |
| return (skb_network_header(skb)[24] == 0xff) ? |
| RTN_MULTICAST : 0; |
| else if (be16_to_cpu(skb->protocol) == ETH_P_IP) |
| return ((skb_network_header(skb)[16] & 0xf0) == 0xe0) ? |
| RTN_MULTICAST : 0; |
| /* ... */ |
| if (!memcmp(skb->data, skb->dev->broadcast, 6)) |
| return RTN_BROADCAST; |
| else { |
| u16 hdr_mac; |
| |
| hdr_mac = *((u16 *)skb->data); |
| /* tr multicast? */ |
| switch (card->info.link_type) { |
| case QETH_LINK_TYPE_HSTR: |
| case QETH_LINK_TYPE_LANE_TR: |
| if ((hdr_mac == QETH_TR_MAC_NC) || |
| (hdr_mac == QETH_TR_MAC_C)) |
| return RTN_MULTICAST; |
| break; |
| /* eth or so multicast? */ |
| default: |
| if ((hdr_mac == QETH_ETH_MAC_V4) || |
| (hdr_mac == QETH_ETH_MAC_V6)) |
| return RTN_MULTICAST; |
| } |
| } |
| return cast_type; |
| } |
| |
| static void qeth_l3_fill_af_iucv_hdr(struct qeth_card *card, |
| struct qeth_hdr *hdr, struct sk_buff *skb) |
| { |
| char daddr[16]; |
| struct af_iucv_trans_hdr *iucv_hdr; |
| |
| memset(hdr, 0, sizeof(struct qeth_hdr)); |
| hdr->hdr.l3.id = QETH_HEADER_TYPE_LAYER3; |
| hdr->hdr.l3.ext_flags = 0; |
| hdr->hdr.l3.length = skb->len - ETH_HLEN; |
| hdr->hdr.l3.flags = QETH_HDR_IPV6 | QETH_CAST_UNICAST; |
| |
| iucv_hdr = (struct af_iucv_trans_hdr *) (skb->data + ETH_HLEN); |
| memset(daddr, 0, sizeof(daddr)); |
| daddr[0] = 0xfe; |
| daddr[1] = 0x80; |
| memcpy(&daddr[8], iucv_hdr->destUserID, 8); |
| memcpy(hdr->hdr.l3.dest_addr, daddr, 16); |
| } |
| |
| static void qeth_l3_fill_header(struct qeth_card *card, struct qeth_hdr *hdr, |
| struct sk_buff *skb, int ipv, int cast_type) |
| { |
| struct dst_entry *dst; |
| |
| memset(hdr, 0, sizeof(struct qeth_hdr)); |
| hdr->hdr.l3.id = QETH_HEADER_TYPE_LAYER3; |
| hdr->hdr.l3.ext_flags = 0; |
| |
| /* |
| * before we're going to overwrite this location with next hop ip. |
| * v6 uses passthrough, v4 sets the tag in the QDIO header. |
| */ |
| if (skb_vlan_tag_present(skb)) { |
| if ((ipv == 4) || (card->info.type == QETH_CARD_TYPE_IQD)) |
| hdr->hdr.l3.ext_flags = QETH_HDR_EXT_VLAN_FRAME; |
| else |
| hdr->hdr.l3.ext_flags = QETH_HDR_EXT_INCLUDE_VLAN_TAG; |
| hdr->hdr.l3.vlan_id = skb_vlan_tag_get(skb); |
| } |
| |
| hdr->hdr.l3.length = skb->len - sizeof(struct qeth_hdr); |
| |
| rcu_read_lock(); |
| dst = skb_dst(skb); |
| if (ipv == 4) { |
| struct rtable *rt = (struct rtable *) dst; |
| __be32 *pkey = &ip_hdr(skb)->daddr; |
| |
| if (rt && rt->rt_gateway) |
| pkey = &rt->rt_gateway; |
| |
| /* IPv4 */ |
| hdr->hdr.l3.flags = qeth_l3_get_qeth_hdr_flags4(cast_type); |
| memset(hdr->hdr.l3.dest_addr, 0, 12); |
| *((__be32 *) (&hdr->hdr.l3.dest_addr[12])) = *pkey; |
| } else if (ipv == 6) { |
| struct rt6_info *rt = (struct rt6_info *) dst; |
| struct in6_addr *pkey = &ipv6_hdr(skb)->daddr; |
| |
| if (rt && !ipv6_addr_any(&rt->rt6i_gateway)) |
| pkey = &rt->rt6i_gateway; |
| |
| /* IPv6 */ |
| hdr->hdr.l3.flags = qeth_l3_get_qeth_hdr_flags6(cast_type); |
| if (card->info.type == QETH_CARD_TYPE_IQD) |
| hdr->hdr.l3.flags &= ~QETH_HDR_PASSTHRU; |
| memcpy(hdr->hdr.l3.dest_addr, pkey, 16); |
| } else { |
| if (!memcmp(skb->data + sizeof(struct qeth_hdr), |
| skb->dev->broadcast, 6)) { |
| /* broadcast? */ |
| hdr->hdr.l3.flags = QETH_CAST_BROADCAST | |
| QETH_HDR_PASSTHRU; |
| } else { |
| hdr->hdr.l3.flags = (cast_type == RTN_MULTICAST) ? |
| QETH_CAST_MULTICAST | QETH_HDR_PASSTHRU : |
| QETH_CAST_UNICAST | QETH_HDR_PASSTHRU; |
| } |
| } |
| rcu_read_unlock(); |
| } |
| |
| static void qeth_l3_hdr_csum(struct qeth_card *card, struct qeth_hdr *hdr, |
| struct sk_buff *skb) |
| { |
| struct iphdr *iph = ip_hdr(skb); |
| |
| /* tcph->check contains already the pseudo hdr checksum |
| * so just set the header flags |
| */ |
| if (iph->protocol == IPPROTO_UDP) |
| hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_UDP; |
| hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_CSUM_TRANSP_REQ | |
| QETH_HDR_EXT_CSUM_HDR_REQ; |
| iph->check = 0; |
| if (card->options.performance_stats) |
| card->perf_stats.tx_csum++; |
| } |
| |
| static void qeth_tso_fill_header(struct qeth_card *card, |
| struct qeth_hdr *qhdr, struct sk_buff *skb) |
| { |
| struct qeth_hdr_tso *hdr = (struct qeth_hdr_tso *)qhdr; |
| struct tcphdr *tcph = tcp_hdr(skb); |
| struct iphdr *iph = ip_hdr(skb); |
| struct ipv6hdr *ip6h = ipv6_hdr(skb); |
| |
| /*fix header to TSO values ...*/ |
| hdr->hdr.hdr.l3.id = QETH_HEADER_TYPE_TSO; |
| hdr->hdr.hdr.l3.length = skb->len - sizeof(struct qeth_hdr_tso); |
| /*set values which are fix for the first approach ...*/ |
| hdr->ext.hdr_tot_len = (__u16) sizeof(struct qeth_hdr_ext_tso); |
| hdr->ext.imb_hdr_no = 1; |
| hdr->ext.hdr_type = 1; |
| hdr->ext.hdr_version = 1; |
| hdr->ext.hdr_len = 28; |
| /*insert non-fix values */ |
| hdr->ext.mss = skb_shinfo(skb)->gso_size; |
| hdr->ext.dg_hdr_len = (__u16)(ip_hdrlen(skb) + tcp_hdrlen(skb)); |
| hdr->ext.payload_len = (__u16)(skb->len - hdr->ext.dg_hdr_len - |
| sizeof(struct qeth_hdr_tso)); |
| tcph->check = 0; |
| if (be16_to_cpu(skb->protocol) == ETH_P_IPV6) { |
| ip6h->payload_len = 0; |
| tcph->check = ~csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr, |
| 0, IPPROTO_TCP, 0); |
| } else { |
| /*OSA want us to set these values ...*/ |
| tcph->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr, |
| 0, IPPROTO_TCP, 0); |
| iph->tot_len = 0; |
| iph->check = 0; |
| } |
| } |
| |
| /** |
| * qeth_l3_get_elements_no_tso() - find number of SBALEs for skb data for tso |
| * @card: qeth card structure, to check max. elems. |
| * @skb: SKB address |
| * @extra_elems: extra elems needed, to check against max. |
| * |
| * Returns the number of pages, and thus QDIO buffer elements, needed to cover |
| * skb data, including linear part and fragments, but excluding TCP header. |
| * (Exclusion of TCP header distinguishes it from qeth_get_elements_no().) |
| * Checks if the result plus extra_elems fits under the limit for the card. |
| * Returns 0 if it does not. |
| * Note: extra_elems is not included in the returned result. |
| */ |
| static int qeth_l3_get_elements_no_tso(struct qeth_card *card, |
| struct sk_buff *skb, int extra_elems) |
| { |
| addr_t tcpdptr = (addr_t)tcp_hdr(skb) + tcp_hdrlen(skb); |
| int elements = qeth_get_elements_for_range( |
| tcpdptr, |
| (addr_t)skb->data + skb_headlen(skb)) + |
| qeth_get_elements_for_frags(skb); |
| |
| if ((elements + extra_elems) > QETH_MAX_BUFFER_ELEMENTS(card)) { |
| QETH_DBF_MESSAGE(2, |
| "Invalid size of TSO IP packet (Number=%d / Length=%d). Discarded.\n", |
| elements + extra_elems, skb->len); |
| return 0; |
| } |
| return elements; |
| } |
| |
| static netdev_tx_t qeth_l3_hard_start_xmit(struct sk_buff *skb, |
| struct net_device *dev) |
| { |
| int rc; |
| __be16 *tag; |
| struct qeth_hdr *hdr = NULL; |
| int hdr_elements = 0; |
| int elements; |
| struct qeth_card *card = dev->ml_priv; |
| struct sk_buff *new_skb = NULL; |
| int ipv = qeth_get_ip_version(skb); |
| int cast_type = qeth_l3_get_cast_type(card, skb); |
| struct qeth_qdio_out_q *queue = |
| card->qdio.out_qs[card->qdio.do_prio_queueing |
| || (cast_type && card->info.is_multicast_different) ? |
| qeth_get_priority_queue(card, skb, ipv, cast_type) : |
| card->qdio.default_out_queue]; |
| int tx_bytes = skb->len; |
| unsigned int hd_len = 0; |
| bool use_tso; |
| int data_offset = -1; |
| unsigned int nr_frags; |
| |
| if (((card->info.type == QETH_CARD_TYPE_IQD) && |
| (((card->options.cq != QETH_CQ_ENABLED) && !ipv) || |
| ((card->options.cq == QETH_CQ_ENABLED) && |
| (be16_to_cpu(skb->protocol) != ETH_P_AF_IUCV)))) || |
| card->options.sniffer) |
| goto tx_drop; |
| |
| if ((card->state != CARD_STATE_UP) || !card->lan_online) { |
| card->stats.tx_carrier_errors++; |
| goto tx_drop; |
| } |
| |
| if ((cast_type == RTN_BROADCAST) && |
| (card->info.broadcast_capable == 0)) |
| goto tx_drop; |
| |
| if (card->options.performance_stats) { |
| card->perf_stats.outbound_cnt++; |
| card->perf_stats.outbound_start_time = qeth_get_micros(); |
| } |
| |
| /* Ignore segment size from skb_is_gso(), 1 page is always used. */ |
| use_tso = skb_is_gso(skb) && |
| (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV4); |
| |
| if (card->info.type == QETH_CARD_TYPE_IQD) { |
| new_skb = skb; |
| data_offset = ETH_HLEN; |
| hd_len = sizeof(*hdr); |
| hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC); |
| if (!hdr) |
| goto tx_drop; |
| hdr_elements++; |
| } else { |
| /* create a clone with writeable headroom */ |
| new_skb = skb_realloc_headroom(skb, sizeof(struct qeth_hdr_tso) |
| + VLAN_HLEN); |
| if (!new_skb) |
| goto tx_drop; |
| |
| if (ipv == 4) { |
| skb_pull(new_skb, ETH_HLEN); |
| } |
| |
| if (ipv != 4 && skb_vlan_tag_present(new_skb)) { |
| skb_push(new_skb, VLAN_HLEN); |
| skb_copy_to_linear_data(new_skb, new_skb->data + 4, 4); |
| skb_copy_to_linear_data_offset(new_skb, 4, |
| new_skb->data + 8, 4); |
| skb_copy_to_linear_data_offset(new_skb, 8, |
| new_skb->data + 12, 4); |
| tag = (__be16 *)(new_skb->data + 12); |
| *tag = cpu_to_be16(ETH_P_8021Q); |
| *(tag + 1) = cpu_to_be16(skb_vlan_tag_get(new_skb)); |
| } |
| } |
| |
| netif_stop_queue(dev); |
| |
| /* fix hardware limitation: as long as we do not have sbal |
| * chaining we can not send long frag lists |
| */ |
| if ((card->info.type != QETH_CARD_TYPE_IQD) && |
| ((use_tso && !qeth_l3_get_elements_no_tso(card, new_skb, 1)) || |
| (!use_tso && !qeth_get_elements_no(card, new_skb, 0, 0)))) { |
| int lin_rc = skb_linearize(new_skb); |
| |
| if (card->options.performance_stats) { |
| if (lin_rc) |
| card->perf_stats.tx_linfail++; |
| else |
| card->perf_stats.tx_lin++; |
| } |
| if (lin_rc) |
| goto tx_drop; |
| } |
| nr_frags = skb_shinfo(new_skb)->nr_frags; |
| |
| if (use_tso) { |
| hdr = skb_push(new_skb, sizeof(struct qeth_hdr_tso)); |
| memset(hdr, 0, sizeof(struct qeth_hdr_tso)); |
| qeth_l3_fill_header(card, hdr, new_skb, ipv, cast_type); |
| qeth_tso_fill_header(card, hdr, new_skb); |
| hdr_elements++; |
| } else { |
| if (data_offset < 0) { |
| hdr = skb_push(new_skb, sizeof(struct qeth_hdr)); |
| qeth_l3_fill_header(card, hdr, new_skb, ipv, |
| cast_type); |
| } else { |
| if (be16_to_cpu(new_skb->protocol) == ETH_P_AF_IUCV) |
| qeth_l3_fill_af_iucv_hdr(card, hdr, new_skb); |
| else { |
| qeth_l3_fill_header(card, hdr, new_skb, ipv, |
| cast_type); |
| hdr->hdr.l3.length = new_skb->len - data_offset; |
| } |
| } |
| |
| if (skb->ip_summed == CHECKSUM_PARTIAL) |
| qeth_l3_hdr_csum(card, hdr, new_skb); |
| } |
| |
| elements = use_tso ? |
| qeth_l3_get_elements_no_tso(card, new_skb, hdr_elements) : |
| qeth_get_elements_no(card, new_skb, hdr_elements, |
| (data_offset > 0) ? data_offset : 0); |
| if (!elements) { |
| if (data_offset >= 0) |
| kmem_cache_free(qeth_core_header_cache, hdr); |
| goto tx_drop; |
| } |
| elements += hdr_elements; |
| |
| if (card->info.type != QETH_CARD_TYPE_IQD) { |
| int len; |
| if (use_tso) { |
| hd_len = sizeof(struct qeth_hdr_tso) + |
| ip_hdrlen(new_skb) + tcp_hdrlen(new_skb); |
| len = hd_len; |
| } else { |
| len = sizeof(struct qeth_hdr_layer3); |
| } |
| |
| if (qeth_hdr_chk_and_bounce(new_skb, &hdr, len)) |
| goto tx_drop; |
| rc = qeth_do_send_packet(card, queue, new_skb, hdr, hd_len, |
| hd_len, elements); |
| } else |
| rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr, |
| data_offset, hd_len); |
| |
| if (!rc) { |
| card->stats.tx_packets++; |
| card->stats.tx_bytes += tx_bytes; |
| if (new_skb != skb) |
| dev_kfree_skb_any(skb); |
| if (card->options.performance_stats) { |
| if (use_tso) { |
| card->perf_stats.large_send_bytes += tx_bytes; |
| card->perf_stats.large_send_cnt++; |
| } |
| if (nr_frags) { |
| card->perf_stats.sg_skbs_sent++; |
| /* nr_frags + skb->data */ |
| card->perf_stats.sg_frags_sent += nr_frags + 1; |
| } |
| } |
| rc = NETDEV_TX_OK; |
| } else { |
| if (data_offset >= 0) |
| kmem_cache_free(qeth_core_header_cache, hdr); |
| |
| if (rc == -EBUSY) { |
| if (new_skb != skb) |
| dev_kfree_skb_any(new_skb); |
| return NETDEV_TX_BUSY; |
| } else |
| goto tx_drop; |
| } |
| |
| netif_wake_queue(dev); |
| if (card->options.performance_stats) |
| card->perf_stats.outbound_time += qeth_get_micros() - |
| card->perf_stats.outbound_start_time; |
| return rc; |
| |
| tx_drop: |
| card->stats.tx_dropped++; |
| card->stats.tx_errors++; |
| if ((new_skb != skb) && new_skb) |
| dev_kfree_skb_any(new_skb); |
| dev_kfree_skb_any(skb); |
| netif_wake_queue(dev); |
| return NETDEV_TX_OK; |
| } |
| |
| static int __qeth_l3_open(struct net_device *dev) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| int rc = 0; |
| |
| QETH_CARD_TEXT(card, 4, "qethopen"); |
| if (card->state == CARD_STATE_UP) |
| return rc; |
| if (card->state != CARD_STATE_SOFTSETUP) |
| return -ENODEV; |
| card->data.state = CH_STATE_UP; |
| card->state = CARD_STATE_UP; |
| netif_start_queue(dev); |
| |
| if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) { |
| napi_enable(&card->napi); |
| napi_schedule(&card->napi); |
| } else |
| rc = -EIO; |
| return rc; |
| } |
| |
| static int qeth_l3_open(struct net_device *dev) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| |
| QETH_CARD_TEXT(card, 5, "qethope_"); |
| if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) { |
| QETH_CARD_TEXT(card, 3, "openREC"); |
| return -ERESTARTSYS; |
| } |
| return __qeth_l3_open(dev); |
| } |
| |
| static int qeth_l3_stop(struct net_device *dev) |
| { |
| struct qeth_card *card = dev->ml_priv; |
| |
| QETH_CARD_TEXT(card, 4, "qethstop"); |
| netif_tx_disable(dev); |
| if (card->state == CARD_STATE_UP) { |
| card->state = CARD_STATE_SOFTSETUP; |
| napi_disable(&card->napi); |
| } |
| return 0; |
| } |
| |
| static const struct ethtool_ops qeth_l3_ethtool_ops = { |
| .get_link = ethtool_op_get_link, |
| .get_strings = qeth_core_get_strings, |
| .get_ethtool_stats = qeth_core_get_ethtool_stats, |
| .get_sset_count = qeth_core_get_sset_count, |
| .get_drvinfo = qeth_core_get_drvinfo, |
| .get_link_ksettings = qeth_core_ethtool_get_link_ksettings, |
| }; |
| |
| /* |
| * we need NOARP for IPv4 but we want neighbor solicitation for IPv6. Setting |
| * NOARP on the netdevice is no option because it also turns off neighbor |
| * solicitation. For IPv4 we install a neighbor_setup function. We don't want |
| * arp resolution but we want the hard header (packet socket will work |
| * e.g. tcpdump) |
| */ |
| static int qeth_l3_neigh_setup_noarp(struct neighbour *n) |
| { |
| n->nud_state = NUD_NOARP; |
| memcpy(n->ha, "FAKELL", 6); |
| n->output = n->ops->connected_output; |
| return 0; |
| } |
| |
| static int |
| qeth_l3_neigh_setup(struct net_device *dev, struct neigh_parms *np) |
| { |
| if (np->tbl->family == AF_INET) |
| np->neigh_setup = qeth_l3_neigh_setup_noarp; |
| |
| return 0; |
| } |
| |
| static const struct net_device_ops qeth_l3_netdev_ops = { |
| .ndo_open = qeth_l3_open, |
| .ndo_stop = qeth_l3_stop, |
| .ndo_get_stats = qeth_get_stats, |
| .ndo_start_xmit = qeth_l3_hard_start_xmit, |
| .ndo_validate_addr = eth_validate_addr, |
| .ndo_set_rx_mode = qeth_l3_set_multicast_list, |
| .ndo_do_ioctl = qeth_do_ioctl, |
| .ndo_change_mtu = qeth_change_mtu, |
| .ndo_fix_features = qeth_fix_features, |
| .ndo_set_features = qeth_set_features, |
| .ndo_vlan_rx_add_vid = qeth_l3_vlan_rx_add_vid, |
| .ndo_vlan_rx_kill_vid = qeth_l3_vlan_rx_kill_vid, |
| .ndo_tx_timeout = qeth_tx_timeout, |
| |