![Julian Wiedmann](/assets/img/avatar_default.png)
Reduce code duplication. Signed-off-by: Julian Wiedmann <jwi@linux.vnet.ibm.com> Signed-off-by: David S. Miller <davem@davemloft.net>
1010 lines
25 KiB
C
1010 lines
25 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright IBM Corp. 2007
|
|
* 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>
|
|
*/
|
|
|
|
#include <linux/slab.h>
|
|
#include <asm/ebcdic.h>
|
|
#include <linux/hashtable.h>
|
|
#include <linux/inet.h>
|
|
#include "qeth_l3.h"
|
|
|
|
#define QETH_DEVICE_ATTR(_id, _name, _mode, _show, _store) \
|
|
struct device_attribute dev_attr_##_id = __ATTR(_name, _mode, _show, _store)
|
|
|
|
static int qeth_l3_string_to_ipaddr(const char *buf,
|
|
enum qeth_prot_versions proto, u8 *addr)
|
|
{
|
|
const char *end;
|
|
|
|
if ((proto == QETH_PROT_IPV4 && !in4_pton(buf, -1, addr, -1, &end)) ||
|
|
(proto == QETH_PROT_IPV6 && !in6_pton(buf, -1, addr, -1, &end)))
|
|
return -EINVAL;
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_route_show(struct qeth_card *card,
|
|
struct qeth_routing_info *route, char *buf)
|
|
{
|
|
switch (route->type) {
|
|
case PRIMARY_ROUTER:
|
|
return sprintf(buf, "%s\n", "primary router");
|
|
case SECONDARY_ROUTER:
|
|
return sprintf(buf, "%s\n", "secondary router");
|
|
case MULTICAST_ROUTER:
|
|
if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
|
|
return sprintf(buf, "%s\n", "multicast router+");
|
|
else
|
|
return sprintf(buf, "%s\n", "multicast router");
|
|
case PRIMARY_CONNECTOR:
|
|
if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
|
|
return sprintf(buf, "%s\n", "primary connector+");
|
|
else
|
|
return sprintf(buf, "%s\n", "primary connector");
|
|
case SECONDARY_CONNECTOR:
|
|
if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
|
|
return sprintf(buf, "%s\n", "secondary connector+");
|
|
else
|
|
return sprintf(buf, "%s\n", "secondary connector");
|
|
default:
|
|
return sprintf(buf, "%s\n", "no");
|
|
}
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_route4_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_route_show(card, &card->options.route4, buf);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_route_store(struct qeth_card *card,
|
|
struct qeth_routing_info *route, enum qeth_prot_versions prot,
|
|
const char *buf, size_t count)
|
|
{
|
|
enum qeth_routing_types old_route_type = route->type;
|
|
int rc = 0;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if (sysfs_streq(buf, "no_router")) {
|
|
route->type = NO_ROUTER;
|
|
} else if (sysfs_streq(buf, "primary_connector")) {
|
|
route->type = PRIMARY_CONNECTOR;
|
|
} else if (sysfs_streq(buf, "secondary_connector")) {
|
|
route->type = SECONDARY_CONNECTOR;
|
|
} else if (sysfs_streq(buf, "primary_router")) {
|
|
route->type = PRIMARY_ROUTER;
|
|
} else if (sysfs_streq(buf, "secondary_router")) {
|
|
route->type = SECONDARY_ROUTER;
|
|
} else if (sysfs_streq(buf, "multicast_router")) {
|
|
route->type = MULTICAST_ROUTER;
|
|
} else {
|
|
rc = -EINVAL;
|
|
goto out;
|
|
}
|
|
if (qeth_card_hw_is_reachable(card) &&
|
|
(old_route_type != route->type)) {
|
|
if (prot == QETH_PROT_IPV4)
|
|
rc = qeth_l3_setrouting_v4(card);
|
|
else if (prot == QETH_PROT_IPV6)
|
|
rc = qeth_l3_setrouting_v6(card);
|
|
}
|
|
out:
|
|
if (rc)
|
|
route->type = old_route_type;
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_route4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_route_store(card, &card->options.route4,
|
|
QETH_PROT_IPV4, buf, count);
|
|
}
|
|
|
|
static DEVICE_ATTR(route4, 0644, qeth_l3_dev_route4_show,
|
|
qeth_l3_dev_route4_store);
|
|
|
|
static ssize_t qeth_l3_dev_route6_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_route_show(card, &card->options.route6, buf);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_route6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_route_store(card, &card->options.route6,
|
|
QETH_PROT_IPV6, buf, count);
|
|
}
|
|
|
|
static DEVICE_ATTR(route6, 0644, qeth_l3_dev_route6_show,
|
|
qeth_l3_dev_route6_store);
|
|
|
|
static ssize_t qeth_l3_dev_fake_broadcast_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return sprintf(buf, "%i\n", card->options.fake_broadcast? 1:0);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_fake_broadcast_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
char *tmp;
|
|
int i, rc = 0;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if ((card->state != CARD_STATE_DOWN) &&
|
|
(card->state != CARD_STATE_RECOVER)) {
|
|
rc = -EPERM;
|
|
goto out;
|
|
}
|
|
|
|
i = simple_strtoul(buf, &tmp, 16);
|
|
if ((i == 0) || (i == 1))
|
|
card->options.fake_broadcast = i;
|
|
else
|
|
rc = -EINVAL;
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static DEVICE_ATTR(fake_broadcast, 0644, qeth_l3_dev_fake_broadcast_show,
|
|
qeth_l3_dev_fake_broadcast_store);
|
|
|
|
static ssize_t qeth_l3_dev_sniffer_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return sprintf(buf, "%i\n", card->options.sniffer ? 1 : 0);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_sniffer_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
int rc = 0;
|
|
unsigned long i;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
if (card->info.type != QETH_CARD_TYPE_IQD)
|
|
return -EPERM;
|
|
if (card->options.cq == QETH_CQ_ENABLED)
|
|
return -EPERM;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if ((card->state != CARD_STATE_DOWN) &&
|
|
(card->state != CARD_STATE_RECOVER)) {
|
|
rc = -EPERM;
|
|
goto out;
|
|
}
|
|
|
|
rc = kstrtoul(buf, 16, &i);
|
|
if (rc) {
|
|
rc = -EINVAL;
|
|
goto out;
|
|
}
|
|
switch (i) {
|
|
case 0:
|
|
card->options.sniffer = i;
|
|
break;
|
|
case 1:
|
|
qdio_get_ssqd_desc(CARD_DDEV(card), &card->ssqd);
|
|
if (card->ssqd.qdioac2 & QETH_SNIFF_AVAIL) {
|
|
card->options.sniffer = i;
|
|
if (card->qdio.init_pool.buf_count !=
|
|
QETH_IN_BUF_COUNT_MAX)
|
|
qeth_realloc_buffer_pool(card,
|
|
QETH_IN_BUF_COUNT_MAX);
|
|
} else
|
|
rc = -EPERM;
|
|
break;
|
|
default:
|
|
rc = -EINVAL;
|
|
}
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static DEVICE_ATTR(sniffer, 0644, qeth_l3_dev_sniffer_show,
|
|
qeth_l3_dev_sniffer_store);
|
|
|
|
|
|
static ssize_t qeth_l3_dev_hsuid_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
char tmp_hsuid[9];
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
if (card->info.type != QETH_CARD_TYPE_IQD)
|
|
return -EPERM;
|
|
|
|
memcpy(tmp_hsuid, card->options.hsuid, sizeof(tmp_hsuid));
|
|
EBCASC(tmp_hsuid, 8);
|
|
return sprintf(buf, "%s\n", tmp_hsuid);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_hsuid_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
char *tmp;
|
|
int rc;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
if (card->info.type != QETH_CARD_TYPE_IQD)
|
|
return -EPERM;
|
|
if (card->state != CARD_STATE_DOWN &&
|
|
card->state != CARD_STATE_RECOVER)
|
|
return -EPERM;
|
|
if (card->options.sniffer)
|
|
return -EPERM;
|
|
if (card->options.cq == QETH_CQ_NOTAVAILABLE)
|
|
return -EPERM;
|
|
|
|
tmp = strsep((char **)&buf, "\n");
|
|
if (strlen(tmp) > 8)
|
|
return -EINVAL;
|
|
|
|
if (card->options.hsuid[0])
|
|
/* delete old ip address */
|
|
qeth_l3_modify_hsuid(card, false);
|
|
|
|
if (strlen(tmp) == 0) {
|
|
/* delete ip address only */
|
|
card->options.hsuid[0] = '\0';
|
|
if (card->dev)
|
|
memcpy(card->dev->perm_addr, card->options.hsuid, 9);
|
|
qeth_configure_cq(card, QETH_CQ_DISABLED);
|
|
return count;
|
|
}
|
|
|
|
if (qeth_configure_cq(card, QETH_CQ_ENABLED))
|
|
return -EPERM;
|
|
|
|
snprintf(card->options.hsuid, sizeof(card->options.hsuid),
|
|
"%-8s", tmp);
|
|
ASCEBC(card->options.hsuid, 8);
|
|
if (card->dev)
|
|
memcpy(card->dev->perm_addr, card->options.hsuid, 9);
|
|
|
|
rc = qeth_l3_modify_hsuid(card, true);
|
|
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static DEVICE_ATTR(hsuid, 0644, qeth_l3_dev_hsuid_show,
|
|
qeth_l3_dev_hsuid_store);
|
|
|
|
|
|
static struct attribute *qeth_l3_device_attrs[] = {
|
|
&dev_attr_route4.attr,
|
|
&dev_attr_route6.attr,
|
|
&dev_attr_fake_broadcast.attr,
|
|
&dev_attr_sniffer.attr,
|
|
&dev_attr_hsuid.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group qeth_l3_device_attr_group = {
|
|
.attrs = qeth_l3_device_attrs,
|
|
};
|
|
|
|
static ssize_t qeth_l3_dev_ipato_enable_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return sprintf(buf, "%i\n", card->ipato.enabled? 1:0);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_enable_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
bool enable;
|
|
int rc = 0;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if ((card->state != CARD_STATE_DOWN) &&
|
|
(card->state != CARD_STATE_RECOVER)) {
|
|
rc = -EPERM;
|
|
goto out;
|
|
}
|
|
|
|
if (sysfs_streq(buf, "toggle")) {
|
|
enable = !card->ipato.enabled;
|
|
} else if (kstrtobool(buf, &enable)) {
|
|
rc = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
if (card->ipato.enabled != enable) {
|
|
card->ipato.enabled = enable;
|
|
spin_lock_bh(&card->ip_lock);
|
|
qeth_l3_update_ipato(card);
|
|
spin_unlock_bh(&card->ip_lock);
|
|
}
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_enable, enable, 0644,
|
|
qeth_l3_dev_ipato_enable_show,
|
|
qeth_l3_dev_ipato_enable_store);
|
|
|
|
static ssize_t qeth_l3_dev_ipato_invert4_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return sprintf(buf, "%i\n", card->ipato.invert4? 1:0);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_invert4_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
bool invert;
|
|
int rc = 0;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if (sysfs_streq(buf, "toggle")) {
|
|
invert = !card->ipato.invert4;
|
|
} else if (kstrtobool(buf, &invert)) {
|
|
rc = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
if (card->ipato.invert4 != invert) {
|
|
card->ipato.invert4 = invert;
|
|
spin_lock_bh(&card->ip_lock);
|
|
qeth_l3_update_ipato(card);
|
|
spin_unlock_bh(&card->ip_lock);
|
|
}
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_invert4, invert4, 0644,
|
|
qeth_l3_dev_ipato_invert4_show,
|
|
qeth_l3_dev_ipato_invert4_store);
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add_show(char *buf, struct qeth_card *card,
|
|
enum qeth_prot_versions proto)
|
|
{
|
|
struct qeth_ipato_entry *ipatoe;
|
|
char addr_str[40];
|
|
int entry_len; /* length of 1 entry string, differs between v4 and v6 */
|
|
int i = 0;
|
|
|
|
entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
|
|
/* add strlen for "/<mask>\n" */
|
|
entry_len += (proto == QETH_PROT_IPV4)? 5 : 6;
|
|
spin_lock_bh(&card->ip_lock);
|
|
list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
|
|
if (ipatoe->proto != proto)
|
|
continue;
|
|
/* String must not be longer than PAGE_SIZE. So we check if
|
|
* string length gets near PAGE_SIZE. Then we can savely display
|
|
* the next IPv6 address (worst case, compared to IPv4) */
|
|
if ((PAGE_SIZE - i) <= entry_len)
|
|
break;
|
|
qeth_l3_ipaddr_to_string(proto, ipatoe->addr, addr_str);
|
|
i += snprintf(buf + i, PAGE_SIZE - i,
|
|
"%s/%i\n", addr_str, ipatoe->mask_bits);
|
|
}
|
|
spin_unlock_bh(&card->ip_lock);
|
|
i += snprintf(buf + i, PAGE_SIZE - i, "\n");
|
|
|
|
return i;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add4_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static int qeth_l3_parse_ipatoe(const char *buf, enum qeth_prot_versions proto,
|
|
u8 *addr, int *mask_bits)
|
|
{
|
|
const char *start, *end;
|
|
char *tmp;
|
|
char buffer[40] = {0, };
|
|
|
|
start = buf;
|
|
/* get address string */
|
|
end = strchr(start, '/');
|
|
if (!end || (end - start >= 40)) {
|
|
return -EINVAL;
|
|
}
|
|
strncpy(buffer, start, end - start);
|
|
if (qeth_l3_string_to_ipaddr(buffer, proto, addr)) {
|
|
return -EINVAL;
|
|
}
|
|
start = end + 1;
|
|
*mask_bits = simple_strtoul(start, &tmp, 10);
|
|
if (!strlen(start) ||
|
|
(tmp == start) ||
|
|
(*mask_bits > ((proto == QETH_PROT_IPV4) ? 32 : 128))) {
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
struct qeth_ipato_entry *ipatoe;
|
|
u8 addr[16];
|
|
int mask_bits;
|
|
int rc = 0;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
|
|
if (rc)
|
|
goto out;
|
|
|
|
ipatoe = kzalloc(sizeof(struct qeth_ipato_entry), GFP_KERNEL);
|
|
if (!ipatoe) {
|
|
rc = -ENOMEM;
|
|
goto out;
|
|
}
|
|
ipatoe->proto = proto;
|
|
memcpy(ipatoe->addr, addr, (proto == QETH_PROT_IPV4)? 4:16);
|
|
ipatoe->mask_bits = mask_bits;
|
|
|
|
rc = qeth_l3_add_ipato_entry(card, ipatoe);
|
|
if (rc)
|
|
kfree(ipatoe);
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_add4, add4, 0644,
|
|
qeth_l3_dev_ipato_add4_show,
|
|
qeth_l3_dev_ipato_add4_store);
|
|
|
|
static ssize_t qeth_l3_dev_ipato_del_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
u8 addr[16];
|
|
int mask_bits;
|
|
int rc = 0;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
|
|
if (!rc)
|
|
rc = qeth_l3_del_ipato_entry(card, proto, addr, mask_bits);
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_del4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_del4, del4, 0200, NULL,
|
|
qeth_l3_dev_ipato_del4_store);
|
|
|
|
static ssize_t qeth_l3_dev_ipato_invert6_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return sprintf(buf, "%i\n", card->ipato.invert6? 1:0);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_invert6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
bool invert;
|
|
int rc = 0;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
if (sysfs_streq(buf, "toggle")) {
|
|
invert = !card->ipato.invert6;
|
|
} else if (kstrtobool(buf, &invert)) {
|
|
rc = -EINVAL;
|
|
goto out;
|
|
}
|
|
|
|
if (card->ipato.invert6 != invert) {
|
|
card->ipato.invert6 = invert;
|
|
spin_lock_bh(&card->ip_lock);
|
|
qeth_l3_update_ipato(card);
|
|
spin_unlock_bh(&card->ip_lock);
|
|
}
|
|
out:
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_invert6, invert6, 0644,
|
|
qeth_l3_dev_ipato_invert6_show,
|
|
qeth_l3_dev_ipato_invert6_store);
|
|
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add6_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_ipato_add6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_add6, add6, 0644,
|
|
qeth_l3_dev_ipato_add6_show,
|
|
qeth_l3_dev_ipato_add6_store);
|
|
|
|
static ssize_t qeth_l3_dev_ipato_del6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(ipato_del6, del6, 0200, NULL,
|
|
qeth_l3_dev_ipato_del6_store);
|
|
|
|
static struct attribute *qeth_ipato_device_attrs[] = {
|
|
&dev_attr_ipato_enable.attr,
|
|
&dev_attr_ipato_invert4.attr,
|
|
&dev_attr_ipato_add4.attr,
|
|
&dev_attr_ipato_del4.attr,
|
|
&dev_attr_ipato_invert6.attr,
|
|
&dev_attr_ipato_add6.attr,
|
|
&dev_attr_ipato_del6.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group qeth_device_ipato_group = {
|
|
.name = "ipa_takeover",
|
|
.attrs = qeth_ipato_device_attrs,
|
|
};
|
|
|
|
static ssize_t qeth_l3_dev_ip_add_show(struct device *dev, char *buf,
|
|
enum qeth_prot_versions proto,
|
|
enum qeth_ip_types type)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
struct qeth_ipaddr *ipaddr;
|
|
char addr_str[40];
|
|
int str_len = 0;
|
|
int entry_len; /* length of 1 entry string, differs between v4 and v6 */
|
|
int i;
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
|
|
entry_len += 2; /* \n + terminator */
|
|
spin_lock_bh(&card->ip_lock);
|
|
hash_for_each(card->ip_htable, i, ipaddr, hnode) {
|
|
if (ipaddr->proto != proto || ipaddr->type != type)
|
|
continue;
|
|
/* String must not be longer than PAGE_SIZE. So we check if
|
|
* string length gets near PAGE_SIZE. Then we can savely display
|
|
* the next IPv6 address (worst case, compared to IPv4) */
|
|
if ((PAGE_SIZE - str_len) <= entry_len)
|
|
break;
|
|
qeth_l3_ipaddr_to_string(proto, (const u8 *)&ipaddr->u,
|
|
addr_str);
|
|
str_len += snprintf(buf + str_len, PAGE_SIZE - str_len, "%s\n",
|
|
addr_str);
|
|
}
|
|
spin_unlock_bh(&card->ip_lock);
|
|
str_len += snprintf(buf + str_len, PAGE_SIZE - str_len, "\n");
|
|
|
|
return str_len;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_vipa_add4_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV4,
|
|
QETH_IP_TYPE_VIPA);
|
|
}
|
|
|
|
static int qeth_l3_parse_vipae(const char *buf, enum qeth_prot_versions proto,
|
|
u8 *addr)
|
|
{
|
|
if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_vipa_add_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
u8 addr[16] = {0, };
|
|
int rc;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_vipae(buf, proto, addr);
|
|
if (!rc)
|
|
rc = qeth_l3_modify_rxip_vipa(card, true, addr,
|
|
QETH_IP_TYPE_VIPA, proto);
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_vipa_add4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(vipa_add4, add4, 0644,
|
|
qeth_l3_dev_vipa_add4_show,
|
|
qeth_l3_dev_vipa_add4_store);
|
|
|
|
static ssize_t qeth_l3_dev_vipa_del_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
u8 addr[16];
|
|
int rc;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_vipae(buf, proto, addr);
|
|
if (!rc)
|
|
rc = qeth_l3_modify_rxip_vipa(card, false, addr,
|
|
QETH_IP_TYPE_VIPA, proto);
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_vipa_del4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(vipa_del4, del4, 0200, NULL,
|
|
qeth_l3_dev_vipa_del4_store);
|
|
|
|
static ssize_t qeth_l3_dev_vipa_add6_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV6,
|
|
QETH_IP_TYPE_VIPA);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_vipa_add6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(vipa_add6, add6, 0644,
|
|
qeth_l3_dev_vipa_add6_show,
|
|
qeth_l3_dev_vipa_add6_store);
|
|
|
|
static ssize_t qeth_l3_dev_vipa_del6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(vipa_del6, del6, 0200, NULL,
|
|
qeth_l3_dev_vipa_del6_store);
|
|
|
|
static struct attribute *qeth_vipa_device_attrs[] = {
|
|
&dev_attr_vipa_add4.attr,
|
|
&dev_attr_vipa_del4.attr,
|
|
&dev_attr_vipa_add6.attr,
|
|
&dev_attr_vipa_del6.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group qeth_device_vipa_group = {
|
|
.name = "vipa",
|
|
.attrs = qeth_vipa_device_attrs,
|
|
};
|
|
|
|
static ssize_t qeth_l3_dev_rxip_add4_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV4,
|
|
QETH_IP_TYPE_RXIP);
|
|
}
|
|
|
|
static int qeth_l3_parse_rxipe(const char *buf, enum qeth_prot_versions proto,
|
|
u8 *addr)
|
|
{
|
|
__be32 ipv4_addr;
|
|
struct in6_addr ipv6_addr;
|
|
|
|
if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
|
|
return -EINVAL;
|
|
}
|
|
if (proto == QETH_PROT_IPV4) {
|
|
memcpy(&ipv4_addr, addr, sizeof(ipv4_addr));
|
|
if (ipv4_is_multicast(ipv4_addr)) {
|
|
QETH_DBF_MESSAGE(2, "multicast rxip not supported.\n");
|
|
return -EINVAL;
|
|
}
|
|
} else if (proto == QETH_PROT_IPV6) {
|
|
memcpy(&ipv6_addr, addr, sizeof(ipv6_addr));
|
|
if (ipv6_addr_is_multicast(&ipv6_addr)) {
|
|
QETH_DBF_MESSAGE(2, "multicast rxip not supported.\n");
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_rxip_add_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
u8 addr[16] = {0, };
|
|
int rc;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_rxipe(buf, proto, addr);
|
|
if (!rc)
|
|
rc = qeth_l3_modify_rxip_vipa(card, true, addr,
|
|
QETH_IP_TYPE_RXIP, proto);
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_rxip_add4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(rxip_add4, add4, 0644,
|
|
qeth_l3_dev_rxip_add4_show,
|
|
qeth_l3_dev_rxip_add4_store);
|
|
|
|
static ssize_t qeth_l3_dev_rxip_del_store(const char *buf, size_t count,
|
|
struct qeth_card *card, enum qeth_prot_versions proto)
|
|
{
|
|
u8 addr[16];
|
|
int rc;
|
|
|
|
mutex_lock(&card->conf_mutex);
|
|
rc = qeth_l3_parse_rxipe(buf, proto, addr);
|
|
if (!rc)
|
|
rc = qeth_l3_modify_rxip_vipa(card, false, addr,
|
|
QETH_IP_TYPE_RXIP, proto);
|
|
mutex_unlock(&card->conf_mutex);
|
|
return rc ? rc : count;
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_rxip_del4_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV4);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(rxip_del4, del4, 0200, NULL,
|
|
qeth_l3_dev_rxip_del4_store);
|
|
|
|
static ssize_t qeth_l3_dev_rxip_add6_show(struct device *dev,
|
|
struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
return qeth_l3_dev_ip_add_show(dev, buf, QETH_PROT_IPV6,
|
|
QETH_IP_TYPE_RXIP);
|
|
}
|
|
|
|
static ssize_t qeth_l3_dev_rxip_add6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(rxip_add6, add6, 0644,
|
|
qeth_l3_dev_rxip_add6_show,
|
|
qeth_l3_dev_rxip_add6_store);
|
|
|
|
static ssize_t qeth_l3_dev_rxip_del6_store(struct device *dev,
|
|
struct device_attribute *attr, const char *buf, size_t count)
|
|
{
|
|
struct qeth_card *card = dev_get_drvdata(dev);
|
|
|
|
if (!card)
|
|
return -EINVAL;
|
|
|
|
return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV6);
|
|
}
|
|
|
|
static QETH_DEVICE_ATTR(rxip_del6, del6, 0200, NULL,
|
|
qeth_l3_dev_rxip_del6_store);
|
|
|
|
static struct attribute *qeth_rxip_device_attrs[] = {
|
|
&dev_attr_rxip_add4.attr,
|
|
&dev_attr_rxip_del4.attr,
|
|
&dev_attr_rxip_add6.attr,
|
|
&dev_attr_rxip_del6.attr,
|
|
NULL,
|
|
};
|
|
|
|
static const struct attribute_group qeth_device_rxip_group = {
|
|
.name = "rxip",
|
|
.attrs = qeth_rxip_device_attrs,
|
|
};
|
|
|
|
static const struct attribute_group *qeth_l3_only_attr_groups[] = {
|
|
&qeth_l3_device_attr_group,
|
|
&qeth_device_ipato_group,
|
|
&qeth_device_vipa_group,
|
|
&qeth_device_rxip_group,
|
|
NULL,
|
|
};
|
|
|
|
int qeth_l3_create_device_attributes(struct device *dev)
|
|
{
|
|
return sysfs_create_groups(&dev->kobj, qeth_l3_only_attr_groups);
|
|
}
|
|
|
|
void qeth_l3_remove_device_attributes(struct device *dev)
|
|
{
|
|
sysfs_remove_groups(&dev->kobj, qeth_l3_only_attr_groups);
|
|
}
|
|
|
|
const struct attribute_group *qeth_l3_attr_groups[] = {
|
|
&qeth_device_attr_group,
|
|
&qeth_device_blkt_group,
|
|
/* l3 specific, see qeth_l3_only_attr_groups: */
|
|
&qeth_l3_device_attr_group,
|
|
&qeth_device_ipato_group,
|
|
&qeth_device_vipa_group,
|
|
&qeth_device_rxip_group,
|
|
NULL,
|
|
};
|