|
@@ -753,19 +753,77 @@ static netdev_tx_t start_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
return NETDEV_TX_OK;
|
|
|
}
|
|
|
|
|
|
+/*
|
|
|
+ * Send command via the control virtqueue and check status. Commands
|
|
|
+ * supported by the hypervisor, as indicated by feature bits, should
|
|
|
+ * never fail unless improperly formated.
|
|
|
+ */
|
|
|
+static bool virtnet_send_command(struct virtnet_info *vi, u8 class, u8 cmd,
|
|
|
+ struct scatterlist *data, int out, int in)
|
|
|
+{
|
|
|
+ struct scatterlist *s, sg[VIRTNET_SEND_COMMAND_SG_MAX + 2];
|
|
|
+ struct virtio_net_ctrl_hdr ctrl;
|
|
|
+ virtio_net_ctrl_ack status = ~0;
|
|
|
+ unsigned int tmp;
|
|
|
+ int i;
|
|
|
+
|
|
|
+ /* Caller should know better */
|
|
|
+ BUG_ON(!virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_VQ) ||
|
|
|
+ (out + in > VIRTNET_SEND_COMMAND_SG_MAX));
|
|
|
+
|
|
|
+ out++; /* Add header */
|
|
|
+ in++; /* Add return status */
|
|
|
+
|
|
|
+ ctrl.class = class;
|
|
|
+ ctrl.cmd = cmd;
|
|
|
+
|
|
|
+ sg_init_table(sg, out + in);
|
|
|
+
|
|
|
+ sg_set_buf(&sg[0], &ctrl, sizeof(ctrl));
|
|
|
+ for_each_sg(data, s, out + in - 2, i)
|
|
|
+ sg_set_buf(&sg[i + 1], sg_virt(s), s->length);
|
|
|
+ sg_set_buf(&sg[out + in - 1], &status, sizeof(status));
|
|
|
+
|
|
|
+ BUG_ON(virtqueue_add_buf(vi->cvq, sg, out, in, vi, GFP_ATOMIC) < 0);
|
|
|
+
|
|
|
+ virtqueue_kick(vi->cvq);
|
|
|
+
|
|
|
+ /* Spin for a response, the kick causes an ioport write, trapping
|
|
|
+ * into the hypervisor, so the request should be handled immediately.
|
|
|
+ */
|
|
|
+ while (!virtqueue_get_buf(vi->cvq, &tmp))
|
|
|
+ cpu_relax();
|
|
|
+
|
|
|
+ return status == VIRTIO_NET_OK;
|
|
|
+}
|
|
|
+
|
|
|
static int virtnet_set_mac_address(struct net_device *dev, void *p)
|
|
|
{
|
|
|
struct virtnet_info *vi = netdev_priv(dev);
|
|
|
struct virtio_device *vdev = vi->vdev;
|
|
|
int ret;
|
|
|
+ struct sockaddr *addr = p;
|
|
|
+ struct scatterlist sg;
|
|
|
|
|
|
- ret = eth_mac_addr(dev, p);
|
|
|
+ ret = eth_prepare_mac_addr_change(dev, p);
|
|
|
if (ret)
|
|
|
return ret;
|
|
|
|
|
|
- if (virtio_has_feature(vdev, VIRTIO_NET_F_MAC))
|
|
|
+ if (virtio_has_feature(vdev, VIRTIO_NET_F_CTRL_MAC_ADDR)) {
|
|
|
+ sg_init_one(&sg, addr->sa_data, dev->addr_len);
|
|
|
+ if (!virtnet_send_command(vi, VIRTIO_NET_CTRL_MAC,
|
|
|
+ VIRTIO_NET_CTRL_MAC_ADDR_SET,
|
|
|
+ &sg, 1, 0)) {
|
|
|
+ dev_warn(&vdev->dev,
|
|
|
+ "Failed to set mac address by vq command.\n");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ } else if (virtio_has_feature(vdev, VIRTIO_NET_F_MAC)) {
|
|
|
vdev->config->set(vdev, offsetof(struct virtio_net_config, mac),
|
|
|
- dev->dev_addr, dev->addr_len);
|
|
|
+ addr->sa_data, dev->addr_len);
|
|
|
+ }
|
|
|
+
|
|
|
+ eth_commit_mac_addr_change(dev, p);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -819,51 +877,6 @@ static void virtnet_netpoll(struct net_device *dev)
|
|
|
}
|
|
|
#endif
|
|
|
|
|
|
-/*
|
|
|
- * Send command via the control virtqueue and check status. Commands
|
|
|
- * supported by the hypervisor, as indicated by feature bits, should
|
|
|
- * never fail unless improperly formated.
|
|
|
- */
|
|
|
-static bool virtnet_send_command(struct virtnet_info *vi, u8 class, u8 cmd,
|
|
|
- struct scatterlist *data, int out, int in)
|
|
|
-{
|
|
|
- struct scatterlist *s, sg[VIRTNET_SEND_COMMAND_SG_MAX + 2];
|
|
|
- struct virtio_net_ctrl_hdr ctrl;
|
|
|
- virtio_net_ctrl_ack status = ~0;
|
|
|
- unsigned int tmp;
|
|
|
- int i;
|
|
|
-
|
|
|
- /* Caller should know better */
|
|
|
- BUG_ON(!virtio_has_feature(vi->vdev, VIRTIO_NET_F_CTRL_VQ) ||
|
|
|
- (out + in > VIRTNET_SEND_COMMAND_SG_MAX));
|
|
|
-
|
|
|
- out++; /* Add header */
|
|
|
- in++; /* Add return status */
|
|
|
-
|
|
|
- ctrl.class = class;
|
|
|
- ctrl.cmd = cmd;
|
|
|
-
|
|
|
- sg_init_table(sg, out + in);
|
|
|
-
|
|
|
- sg_set_buf(&sg[0], &ctrl, sizeof(ctrl));
|
|
|
- for_each_sg(data, s, out + in - 2, i)
|
|
|
- sg_set_buf(&sg[i + 1], sg_virt(s), s->length);
|
|
|
- sg_set_buf(&sg[out + in - 1], &status, sizeof(status));
|
|
|
-
|
|
|
- BUG_ON(virtqueue_add_buf(vi->cvq, sg, out, in, vi, GFP_ATOMIC) < 0);
|
|
|
-
|
|
|
- virtqueue_kick(vi->cvq);
|
|
|
-
|
|
|
- /*
|
|
|
- * Spin for a response, the kick causes an ioport write, trapping
|
|
|
- * into the hypervisor, so the request should be handled immediately.
|
|
|
- */
|
|
|
- while (!virtqueue_get_buf(vi->cvq, &tmp))
|
|
|
- cpu_relax();
|
|
|
-
|
|
|
- return status == VIRTIO_NET_OK;
|
|
|
-}
|
|
|
-
|
|
|
static void virtnet_ack_link_announce(struct virtnet_info *vi)
|
|
|
{
|
|
|
rtnl_lock();
|
|
@@ -1628,6 +1641,7 @@ static unsigned int features[] = {
|
|
|
VIRTIO_NET_F_MRG_RXBUF, VIRTIO_NET_F_STATUS, VIRTIO_NET_F_CTRL_VQ,
|
|
|
VIRTIO_NET_F_CTRL_RX, VIRTIO_NET_F_CTRL_VLAN,
|
|
|
VIRTIO_NET_F_GUEST_ANNOUNCE, VIRTIO_NET_F_MQ,
|
|
|
+ VIRTIO_NET_F_CTRL_MAC_ADDR,
|
|
|
};
|
|
|
|
|
|
static struct virtio_driver virtio_net_driver = {
|