|
@@ -27,10 +27,7 @@ static int qeth_l2_set_offline(struct ccwgroup_device *);
|
|
|
static int qeth_l2_stop(struct net_device *);
|
|
|
static int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
|
|
|
static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
|
|
|
- enum qeth_ipa_cmds,
|
|
|
- int (*reply_cb) (struct qeth_card *,
|
|
|
- struct qeth_reply*,
|
|
|
- unsigned long));
|
|
|
+ enum qeth_ipa_cmds);
|
|
|
static void qeth_l2_set_multicast_list(struct net_device *);
|
|
|
static int qeth_l2_recover(void *);
|
|
|
static void qeth_bridgeport_query_support(struct qeth_card *card);
|
|
@@ -130,56 +127,71 @@ static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
|
|
|
return ndev;
|
|
|
}
|
|
|
|
|
|
-static int qeth_l2_send_setgroupmac_cb(struct qeth_card *card,
|
|
|
- struct qeth_reply *reply,
|
|
|
- unsigned long data)
|
|
|
+static int qeth_setdel_makerc(struct qeth_card *card, int retcode)
|
|
|
{
|
|
|
- struct qeth_ipa_cmd *cmd;
|
|
|
- __u8 *mac;
|
|
|
+ int rc;
|
|
|
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Sgmacb");
|
|
|
- cmd = (struct qeth_ipa_cmd *) data;
|
|
|
- mac = &cmd->data.setdelmac.mac[0];
|
|
|
- /* MAC already registered, needed in couple/uncouple case */
|
|
|
- if (cmd->hdr.return_code == IPA_RC_L2_DUP_MAC) {
|
|
|
- QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
|
|
|
- mac, QETH_CARD_IFNAME(card));
|
|
|
- cmd->hdr.return_code = 0;
|
|
|
+ if (retcode)
|
|
|
+ QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
|
|
|
+ switch (retcode) {
|
|
|
+ case IPA_RC_SUCCESS:
|
|
|
+ rc = 0;
|
|
|
+ break;
|
|
|
+ case IPA_RC_L2_UNSUPPORTED_CMD:
|
|
|
+ rc = -ENOSYS;
|
|
|
+ break;
|
|
|
+ case IPA_RC_L2_ADDR_TABLE_FULL:
|
|
|
+ rc = -ENOSPC;
|
|
|
+ break;
|
|
|
+ case IPA_RC_L2_DUP_MAC:
|
|
|
+ case IPA_RC_L2_DUP_LAYER3_MAC:
|
|
|
+ rc = -EEXIST;
|
|
|
+ break;
|
|
|
+ case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
|
|
|
+ case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
|
|
|
+ rc = -EPERM;
|
|
|
+ break;
|
|
|
+ case IPA_RC_L2_MAC_NOT_FOUND:
|
|
|
+ rc = -ENOENT;
|
|
|
+ break;
|
|
|
+ case -ENOMEM:
|
|
|
+ rc = -ENOMEM;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ rc = -EIO;
|
|
|
+ break;
|
|
|
}
|
|
|
- if (cmd->hdr.return_code)
|
|
|
- QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
|
|
|
- mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
|
|
|
- return 0;
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
|
|
|
{
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Sgmac");
|
|
|
- return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC,
|
|
|
- qeth_l2_send_setgroupmac_cb);
|
|
|
-}
|
|
|
-
|
|
|
-static int qeth_l2_send_delgroupmac_cb(struct qeth_card *card,
|
|
|
- struct qeth_reply *reply,
|
|
|
- unsigned long data)
|
|
|
-{
|
|
|
- struct qeth_ipa_cmd *cmd;
|
|
|
- __u8 *mac;
|
|
|
+ int rc;
|
|
|
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Dgmacb");
|
|
|
- cmd = (struct qeth_ipa_cmd *) data;
|
|
|
- mac = &cmd->data.setdelmac.mac[0];
|
|
|
- if (cmd->hdr.return_code)
|
|
|
- QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
|
|
|
- mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
|
|
|
- return 0;
|
|
|
+ QETH_CARD_TEXT(card, 2, "L2Sgmac");
|
|
|
+ rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
|
|
|
+ IPA_CMD_SETGMAC));
|
|
|
+ if (rc == -EEXIST)
|
|
|
+ QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s\n",
|
|
|
+ mac, QETH_CARD_IFNAME(card));
|
|
|
+ else if (rc)
|
|
|
+ QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %d\n",
|
|
|
+ mac, QETH_CARD_IFNAME(card), rc);
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
|
|
|
{
|
|
|
+ int rc;
|
|
|
+
|
|
|
QETH_CARD_TEXT(card, 2, "L2Dgmac");
|
|
|
- return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC,
|
|
|
- qeth_l2_send_delgroupmac_cb);
|
|
|
+ rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
|
|
|
+ IPA_CMD_DELGMAC));
|
|
|
+ if (rc)
|
|
|
+ QETH_DBF_MESSAGE(2,
|
|
|
+ "Could not delete group MAC %pM on %s: %d\n",
|
|
|
+ mac, QETH_CARD_IFNAME(card), rc);
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
|
|
@@ -197,10 +209,11 @@ static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
|
|
|
mc->is_vmac = vmac;
|
|
|
|
|
|
if (vmac) {
|
|
|
- rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
|
|
|
- NULL);
|
|
|
+ rc = qeth_setdel_makerc(card,
|
|
|
+ qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC));
|
|
|
} else {
|
|
|
- rc = qeth_l2_send_setgroupmac(card, mac);
|
|
|
+ rc = qeth_setdel_makerc(card,
|
|
|
+ qeth_l2_send_setgroupmac(card, mac));
|
|
|
}
|
|
|
|
|
|
if (!rc)
|
|
@@ -218,7 +231,7 @@ static void qeth_l2_del_all_mc(struct qeth_card *card, int del)
|
|
|
if (del) {
|
|
|
if (mc->is_vmac)
|
|
|
qeth_l2_send_setdelmac(card, mc->mc_addr,
|
|
|
- IPA_CMD_DELVMAC, NULL);
|
|
|
+ IPA_CMD_DELVMAC);
|
|
|
else
|
|
|
qeth_l2_send_delgroupmac(card, mc->mc_addr);
|
|
|
}
|
|
@@ -291,6 +304,8 @@ static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
|
|
|
|
|
|
QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
|
|
|
iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
|
|
|
+ if (!iob)
|
|
|
+ return -ENOMEM;
|
|
|
cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
|
|
|
cmd->data.setdelvlan.vlan_id = i;
|
|
|
return qeth_send_ipa_cmd(card, iob,
|
|
@@ -313,6 +328,7 @@ static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
|
|
|
{
|
|
|
struct qeth_card *card = dev->ml_priv;
|
|
|
struct qeth_vlan_vid *id;
|
|
|
+ int rc;
|
|
|
|
|
|
QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
|
|
|
if (!vid)
|
|
@@ -328,7 +344,11 @@ static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
|
|
|
id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
|
|
|
if (id) {
|
|
|
id->vid = vid;
|
|
|
- qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
|
|
|
+ rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
|
|
|
+ if (rc) {
|
|
|
+ kfree(id);
|
|
|
+ return rc;
|
|
|
+ }
|
|
|
spin_lock_bh(&card->vlanlock);
|
|
|
list_add_tail(&id->list, &card->vid_list);
|
|
|
spin_unlock_bh(&card->vlanlock);
|
|
@@ -343,6 +363,7 @@ static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
|
|
|
{
|
|
|
struct qeth_vlan_vid *id, *tmpid = NULL;
|
|
|
struct qeth_card *card = dev->ml_priv;
|
|
|
+ int rc = 0;
|
|
|
|
|
|
QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
|
|
|
if (card->info.type == QETH_CARD_TYPE_OSM) {
|
|
@@ -363,11 +384,11 @@ static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
|
|
|
}
|
|
|
spin_unlock_bh(&card->vlanlock);
|
|
|
if (tmpid) {
|
|
|
- qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
|
|
|
+ rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
|
|
|
kfree(tmpid);
|
|
|
}
|
|
|
qeth_l2_set_multicast_list(card->dev);
|
|
|
- return 0;
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
|
|
@@ -539,91 +560,62 @@ out:
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
|
|
|
- enum qeth_ipa_cmds ipacmd,
|
|
|
- int (*reply_cb) (struct qeth_card *,
|
|
|
- struct qeth_reply*,
|
|
|
- unsigned long))
|
|
|
+ enum qeth_ipa_cmds ipacmd)
|
|
|
{
|
|
|
struct qeth_ipa_cmd *cmd;
|
|
|
struct qeth_cmd_buffer *iob;
|
|
|
|
|
|
QETH_CARD_TEXT(card, 2, "L2sdmac");
|
|
|
iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
|
|
|
+ if (!iob)
|
|
|
+ return -ENOMEM;
|
|
|
cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
|
|
|
cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
|
|
|
memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
|
|
|
- return qeth_send_ipa_cmd(card, iob, reply_cb, NULL);
|
|
|
+ return qeth_send_ipa_cmd(card, iob, NULL, NULL);
|
|
|
}
|
|
|
|
|
|
-static int qeth_l2_send_setmac_cb(struct qeth_card *card,
|
|
|
- struct qeth_reply *reply,
|
|
|
- unsigned long data)
|
|
|
+static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
|
|
|
{
|
|
|
- struct qeth_ipa_cmd *cmd;
|
|
|
+ int rc;
|
|
|
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Smaccb");
|
|
|
- cmd = (struct qeth_ipa_cmd *) data;
|
|
|
- if (cmd->hdr.return_code) {
|
|
|
- QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code);
|
|
|
+ QETH_CARD_TEXT(card, 2, "L2Setmac");
|
|
|
+ rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
|
|
|
+ IPA_CMD_SETVMAC));
|
|
|
+ if (rc == 0) {
|
|
|
+ card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
|
|
|
+ memcpy(card->dev->dev_addr, mac, OSA_ADDR_LEN);
|
|
|
+ dev_info(&card->gdev->dev,
|
|
|
+ "MAC address %pM successfully registered on device %s\n",
|
|
|
+ card->dev->dev_addr, card->dev->name);
|
|
|
+ } else {
|
|
|
card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
|
|
|
- switch (cmd->hdr.return_code) {
|
|
|
- case IPA_RC_L2_DUP_MAC:
|
|
|
- case IPA_RC_L2_DUP_LAYER3_MAC:
|
|
|
+ switch (rc) {
|
|
|
+ case -EEXIST:
|
|
|
dev_warn(&card->gdev->dev,
|
|
|
- "MAC address %pM already exists\n",
|
|
|
- cmd->data.setdelmac.mac);
|
|
|
+ "MAC address %pM already exists\n", mac);
|
|
|
break;
|
|
|
- case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
|
|
|
- case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
|
|
|
+ case -EPERM:
|
|
|
dev_warn(&card->gdev->dev,
|
|
|
- "MAC address %pM is not authorized\n",
|
|
|
- cmd->data.setdelmac.mac);
|
|
|
- break;
|
|
|
- default:
|
|
|
+ "MAC address %pM is not authorized\n", mac);
|
|
|
break;
|
|
|
}
|
|
|
- } else {
|
|
|
- card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
|
|
|
- memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac,
|
|
|
- OSA_ADDR_LEN);
|
|
|
- dev_info(&card->gdev->dev,
|
|
|
- "MAC address %pM successfully registered on device %s\n",
|
|
|
- card->dev->dev_addr, card->dev->name);
|
|
|
- }
|
|
|
- return 0;
|
|
|
-}
|
|
|
-
|
|
|
-static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
|
|
|
-{
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Setmac");
|
|
|
- return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
|
|
|
- qeth_l2_send_setmac_cb);
|
|
|
-}
|
|
|
-
|
|
|
-static int qeth_l2_send_delmac_cb(struct qeth_card *card,
|
|
|
- struct qeth_reply *reply,
|
|
|
- unsigned long data)
|
|
|
-{
|
|
|
- struct qeth_ipa_cmd *cmd;
|
|
|
-
|
|
|
- QETH_CARD_TEXT(card, 2, "L2Dmaccb");
|
|
|
- cmd = (struct qeth_ipa_cmd *) data;
|
|
|
- if (cmd->hdr.return_code) {
|
|
|
- QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
|
|
|
- return 0;
|
|
|
}
|
|
|
- card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
|
|
|
-
|
|
|
- return 0;
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
|
|
|
{
|
|
|
+ int rc;
|
|
|
+
|
|
|
QETH_CARD_TEXT(card, 2, "L2Delmac");
|
|
|
if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
|
|
|
return 0;
|
|
|
- return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC,
|
|
|
- qeth_l2_send_delmac_cb);
|
|
|
+ rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
|
|
|
+ IPA_CMD_DELVMAC));
|
|
|
+ if (rc == 0)
|
|
|
+ card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
|
|
|
+ return rc;
|
|
|
}
|
|
|
|
|
|
static int qeth_l2_request_initial_mac(struct qeth_card *card)
|
|
@@ -651,7 +643,7 @@ static int qeth_l2_request_initial_mac(struct qeth_card *card)
|
|
|
if (rc) {
|
|
|
QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
|
|
|
"device %s: x%x\n", CARD_BUS_ID(card), rc);
|
|
|
- QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
|
|
|
+ QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc);
|
|
|
return rc;
|
|
|
}
|
|
|
QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
|
|
@@ -687,7 +679,7 @@ static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
|
|
|
return -ERESTARTSYS;
|
|
|
}
|
|
|
rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
|
|
|
- if (!rc || (rc == IPA_RC_L2_MAC_NOT_FOUND))
|
|
|
+ if (!rc || (rc == -ENOENT))
|
|
|
rc = qeth_l2_send_setmac(card, addr->sa_data);
|
|
|
return rc ? -EINVAL : 0;
|
|
|
}
|
|
@@ -996,7 +988,7 @@ static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
|
|
|
recover_flag = card->state;
|
|
|
rc = qeth_core_hardsetup_card(card);
|
|
|
if (rc) {
|
|
|
- QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
|
|
|
+ QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
|
|
|
rc = -ENODEV;
|
|
|
goto out_remove;
|
|
|
}
|
|
@@ -1730,6 +1722,8 @@ static void qeth_bridgeport_query_support(struct qeth_card *card)
|
|
|
|
|
|
QETH_CARD_TEXT(card, 2, "brqsuppo");
|
|
|
iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
|
|
|
+ if (!iob)
|
|
|
+ return;
|
|
|
cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
|
|
|
cmd->data.sbp.hdr.cmdlength =
|
|
|
sizeof(struct qeth_ipacmd_sbp_hdr) +
|
|
@@ -1805,6 +1799,8 @@ int qeth_bridgeport_query_ports(struct qeth_card *card,
|
|
|
if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS))
|
|
|
return -EOPNOTSUPP;
|
|
|
iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
|
|
|
+ if (!iob)
|
|
|
+ return -ENOMEM;
|
|
|
cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
|
|
|
cmd->data.sbp.hdr.cmdlength =
|
|
|
sizeof(struct qeth_ipacmd_sbp_hdr);
|
|
@@ -1817,9 +1813,7 @@ int qeth_bridgeport_query_ports(struct qeth_card *card,
|
|
|
if (rc)
|
|
|
return rc;
|
|
|
rc = qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS);
|
|
|
- if (rc)
|
|
|
- return rc;
|
|
|
- return 0;
|
|
|
+ return rc;
|
|
|
}
|
|
|
EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports);
|
|
|
|
|
@@ -1873,6 +1867,8 @@ int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role)
|
|
|
if (!(card->options.sbp.supported_funcs & setcmd))
|
|
|
return -EOPNOTSUPP;
|
|
|
iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
|
|
|
+ if (!iob)
|
|
|
+ return -ENOMEM;
|
|
|
cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
|
|
|
cmd->data.sbp.hdr.cmdlength = cmdlength;
|
|
|
cmd->data.sbp.hdr.command_code = setcmd;
|