2023-03-22 04:49:43 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* drivers/virtio/virtio-net.c
|
|
|
|
*
|
|
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
|
|
* this work for additional information regarding copyright ownership. The
|
|
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
|
|
* "License"); you may not use this file except in compliance with the
|
|
|
|
* License. You may obtain a copy of the License at
|
|
|
|
*
|
|
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
|
|
*
|
|
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
|
|
* License for the specific language governing permissions and limitations
|
|
|
|
* under the License.
|
|
|
|
*
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Included Files
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
#include <debug.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <stdint.h>
|
|
|
|
#include <string.h>
|
|
|
|
|
|
|
|
#include <nuttx/compiler.h>
|
|
|
|
#include <nuttx/kmalloc.h>
|
2023-08-18 22:23:01 +02:00
|
|
|
#include <nuttx/net/ip.h>
|
2023-03-22 04:49:43 +01:00
|
|
|
#include <nuttx/net/netdev_lowerhalf.h>
|
|
|
|
#include <nuttx/virtio/virtio.h>
|
2023-10-23 08:06:12 +02:00
|
|
|
#include <nuttx/net/wifi_sim.h>
|
2023-03-22 04:49:43 +01:00
|
|
|
|
|
|
|
#include "virtio-net.h"
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Pre-processor Definitions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2024-05-21 13:59:49 +02:00
|
|
|
/* Virtio net feature bits */
|
|
|
|
|
2023-12-04 07:21:45 +01:00
|
|
|
#define VIRTIO_NET_F_MAC 5
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/* Virtio net header size and packet buffer size */
|
|
|
|
|
|
|
|
#define VIRTIO_NET_HDRSIZE (sizeof(struct virtio_net_hdr_s))
|
2023-07-04 12:18:47 +02:00
|
|
|
#define VIRTIO_NET_LLHDRSIZE (sizeof(struct virtio_net_llhdr_s))
|
2023-07-04 13:01:00 +02:00
|
|
|
#define VIRTIO_NET_BUFSIZE (CONFIG_NET_ETH_PKTSIZE + CONFIG_NET_GUARDSIZE)
|
2023-03-22 04:49:43 +01:00
|
|
|
|
|
|
|
/* Virtio net virtqueue index and number */
|
|
|
|
|
|
|
|
#define VIRTIO_NET_RX 0
|
|
|
|
#define VIRTIO_NET_TX 1
|
|
|
|
#define VIRTIO_NET_NUM 2
|
|
|
|
|
2023-07-04 13:01:00 +02:00
|
|
|
#define VIRTIO_NET_MAX_PKT_SIZE \
|
|
|
|
((CONFIG_NET_LL_GUARDSIZE - ETH_HDRLEN) + VIRTIO_NET_BUFSIZE)
|
|
|
|
#define VIRTIO_NET_MAX_NIOB \
|
|
|
|
((VIRTIO_NET_MAX_PKT_SIZE + CONFIG_IOB_BUFSIZE - 1) / CONFIG_IOB_BUFSIZE)
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Private Types
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/* Virtio net header, just define it here for further, now only use it
|
|
|
|
* to calculate the virto net header size, see marco VIRTIO_NET_HDRSIZE
|
|
|
|
*/
|
|
|
|
|
|
|
|
begin_packed_struct struct virtio_net_hdr_s
|
|
|
|
{
|
|
|
|
uint8_t flags;
|
|
|
|
uint8_t gso_type;
|
|
|
|
uint16_t hdr_len;
|
|
|
|
uint16_t gso_size;
|
|
|
|
uint16_t csum_start;
|
|
|
|
uint16_t csum_offset;
|
|
|
|
} end_packed_struct;
|
|
|
|
|
2023-12-04 07:21:45 +01:00
|
|
|
/* The definition of the struct virtio_net_config refers to the link
|
|
|
|
* https://docs.oasis-open.org/virtio/virtio/v1.2/cs01/
|
|
|
|
* virtio-v1.2-cs01.html#x1-2230004.
|
|
|
|
*/
|
|
|
|
|
|
|
|
begin_packed_struct struct virtio_net_config_s
|
|
|
|
{
|
|
|
|
uint8_t mac[IFHWADDRLEN]; /* VIRTIO_NET_F_MAC */
|
|
|
|
uint16_t status; /* VIRTIO_NET_F_STATUS */
|
|
|
|
uint16_t max_virtqueue_pairs; /* VIRTIO_NET_F_MQ */
|
|
|
|
uint16_t mtu; /* VIRTIO_NET_F_MTU */
|
|
|
|
uint32_t speed; /* VIRTIO_NET_F_SPEED_DUPLEX */
|
|
|
|
uint8_t duplex;
|
|
|
|
uint8_t rss_max_key_size; /* VIRTIO_NET_F_RSS */
|
|
|
|
uint16_t rss_max_indirection_table_length;
|
|
|
|
uint32_t supported_hash_types;
|
|
|
|
} end_packed_struct;
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
struct virtio_net_priv_s
|
|
|
|
{
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
|
|
|
/* wifi device information, which includes the netdev lowerhalf */
|
|
|
|
|
|
|
|
struct wifi_sim_lowerhalf_s lower;
|
|
|
|
#else
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/* This holds the information visible to the NuttX network */
|
|
|
|
|
|
|
|
struct netdev_lowerhalf_s lower; /* The netdev lowerhalf */
|
2023-10-23 08:06:12 +02:00
|
|
|
#endif
|
2023-03-22 04:49:43 +01:00
|
|
|
|
|
|
|
/* Virtio device information */
|
|
|
|
|
|
|
|
FAR struct virtio_device *vdev; /* Virtio device pointer */
|
|
|
|
int bufnum; /* TX and RX Buffer number */
|
|
|
|
};
|
|
|
|
|
|
|
|
/* Virtio Link Layer Header, follow shows the iob buffer layout:
|
|
|
|
*
|
|
|
|
* |<-- CONFIG_NET_LL_GUARDSIZE -->|
|
|
|
|
* +---------------+---------------+------------+------+ +-------------+
|
|
|
|
* | Virtio Header | ETH Header | data | free | --> | next netpkt |
|
|
|
|
* +---------------+---------------+------------+------+ +-------------+
|
|
|
|
* | |<--------- datalen -------->|
|
|
|
|
* ^base ^data
|
|
|
|
*
|
2023-07-04 12:18:47 +02:00
|
|
|
* CONFIG_NET_LL_GUARDSIZE >= VIRTIO_NET_LLHDRSIZE + ETH_HDR_SIZE
|
|
|
|
* = sizeof(uintptr) + 10 + 14
|
|
|
|
* = 32 (64-Bit)
|
|
|
|
* = 28 (32-Bit)
|
2023-03-22 04:49:43 +01:00
|
|
|
*/
|
|
|
|
|
2023-07-04 12:18:47 +02:00
|
|
|
begin_packed_struct struct virtio_net_llhdr_s
|
2023-03-22 04:49:43 +01:00
|
|
|
{
|
|
|
|
FAR netpkt_t *pkt; /* Netpaket pointer */
|
|
|
|
struct virtio_net_hdr_s vhdr; /* Virtio net header */
|
2023-07-04 12:18:47 +02:00
|
|
|
} end_packed_struct;
|
|
|
|
|
|
|
|
static_assert(CONFIG_NET_LL_GUARDSIZE >= VIRTIO_NET_LLHDRSIZE + ETH_HDRLEN,
|
|
|
|
"CONFIG_NET_LL_GUARDSIZE cannot be less than ETH_HDRLEN"
|
|
|
|
" + VIRTIO_NET_LLHDRSIZE");
|
2023-03-22 04:49:43 +01:00
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Function Prototypes
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_ifup(FAR struct netdev_lowerhalf_s *dev);
|
|
|
|
static int virtio_net_ifdown(FAR struct netdev_lowerhalf_s *dev);
|
|
|
|
static int virtio_net_send(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR netpkt_t *pkt);
|
|
|
|
static netpkt_t *virtio_net_recv(FAR struct netdev_lowerhalf_s *dev);
|
|
|
|
#ifdef CONFIG_NET_MCASTGROUP
|
|
|
|
static int virtio_net_addmac(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR const uint8_t *mac);
|
|
|
|
static int virtio_net_rmmac(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR const uint8_t *mac);
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_NETDEV_IOCTL
|
2023-10-23 08:06:12 +02:00
|
|
|
static int virtio_net_ioctl(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
int cmd, unsigned long arg);
|
2023-03-22 04:49:43 +01:00
|
|
|
#endif
|
2024-08-05 09:24:20 +02:00
|
|
|
static void virtio_net_txfree(FAR struct netdev_lowerhalf_s *dev);
|
2023-03-22 04:49:43 +01:00
|
|
|
|
|
|
|
static int virtio_net_probe(FAR struct virtio_device *vdev);
|
|
|
|
static void virtio_net_remove(FAR struct virtio_device *vdev);
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Private Data
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static struct virtio_driver g_virtio_net_driver =
|
|
|
|
{
|
|
|
|
LIST_INITIAL_VALUE(g_virtio_net_driver.node), /* node */
|
|
|
|
VIRTIO_ID_NETWORK, /* device id */
|
|
|
|
virtio_net_probe, /* probe */
|
|
|
|
virtio_net_remove, /* remove */
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct netdev_ops_s g_virtio_net_ops =
|
|
|
|
{
|
|
|
|
virtio_net_ifup,
|
|
|
|
virtio_net_ifdown,
|
|
|
|
virtio_net_send,
|
|
|
|
virtio_net_recv,
|
|
|
|
#ifdef CONFIG_NET_MCASTGROUP
|
|
|
|
virtio_net_addmac,
|
|
|
|
virtio_net_rmmac,
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_NETDEV_IOCTL
|
|
|
|
virtio_net_ioctl,
|
|
|
|
#endif
|
2024-08-05 09:24:20 +02:00
|
|
|
virtio_net_txfree
|
2023-03-22 04:49:43 +01:00
|
|
|
};
|
|
|
|
|
2024-03-28 13:14:10 +01:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
|
|
|
static uint8_t g_netdev_num = 0;
|
|
|
|
#endif
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Private Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
2024-05-21 13:59:49 +02:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_addbuffer
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_addbuffer(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR struct virtqueue *vq, FAR netpkt_t *pkt,
|
|
|
|
unsigned int vq_id)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
FAR struct virtio_net_llhdr_s *hdr;
|
|
|
|
struct virtqueue_buf vb[VIRTIO_NET_MAX_NIOB + 1];
|
|
|
|
struct iovec iov[VIRTIO_NET_MAX_NIOB];
|
|
|
|
int iov_cnt;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* Convert netpkt to virtqueue_buf */
|
|
|
|
|
|
|
|
iov_cnt = netpkt_to_iov(dev, pkt, iov, VIRTIO_NET_MAX_NIOB);
|
|
|
|
|
|
|
|
/* Alloc cookie and net header from transport layer */
|
|
|
|
|
|
|
|
hdr = (FAR struct virtio_net_llhdr_s *)
|
|
|
|
((FAR uint8_t *)iov[0].iov_base - VIRTIO_NET_LLHDRSIZE);
|
|
|
|
DEBUGASSERT((FAR uint8_t *)hdr >= netpkt_getbase(pkt));
|
|
|
|
memset(&hdr->vhdr, 0, sizeof(hdr->vhdr));
|
|
|
|
hdr->pkt = pkt;
|
|
|
|
|
|
|
|
/* Prepare buffers depends on the feature VIRTIO_F_ANY_LAYOUT */
|
|
|
|
|
|
|
|
if (virtio_has_feature(priv->vdev, VIRTIO_F_ANY_LAYOUT))
|
|
|
|
{
|
|
|
|
/* Append the virtio net header to the first buffer */
|
|
|
|
|
|
|
|
vb[0].buf = &hdr->vhdr;
|
|
|
|
vb[0].len = iov[0].iov_len + VIRTIO_NET_HDRSIZE;
|
|
|
|
|
|
|
|
#if VIRTIO_NET_MAX_NIOB > 1
|
|
|
|
for (i = 1; i < iov_cnt; i++)
|
|
|
|
{
|
|
|
|
vb[i].buf = iov[i].iov_base;
|
|
|
|
vb[i].len = iov[i].iov_len;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Buffer 0 is only for virtio net header */
|
|
|
|
|
|
|
|
vb[0].buf = &hdr->vhdr;
|
|
|
|
vb[0].len = VIRTIO_NET_HDRSIZE;
|
|
|
|
|
|
|
|
for (i = 0; i < iov_cnt; i++)
|
|
|
|
{
|
|
|
|
vb[i + 1].buf = iov[i].iov_base;
|
|
|
|
vb[i + 1].len = iov[i].iov_len;
|
|
|
|
}
|
|
|
|
|
|
|
|
iov_cnt++;
|
|
|
|
}
|
|
|
|
|
|
|
|
vrtinfo("Fill vq=%u, hdr=%p, count=%d\n", vq_id, hdr, iov_cnt);
|
|
|
|
if (vq_id == VIRTIO_NET_RX)
|
|
|
|
{
|
|
|
|
return virtqueue_add_buffer(vq, vb, 0, iov_cnt, hdr);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
return virtqueue_add_buffer(vq, vb, iov_cnt, 0, hdr);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_rxfill
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void virtio_net_rxfill(FAR struct netdev_lowerhalf_s *dev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
FAR struct virtqueue *vq = priv->vdev->vrings_info[VIRTIO_NET_RX].vq;
|
|
|
|
FAR netpkt_t *pkt;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < priv->bufnum; i++)
|
|
|
|
{
|
|
|
|
/* IOB Offload, Alloc buffer from RX netpkt */
|
|
|
|
|
|
|
|
pkt = netpkt_alloc(dev, NETPKT_RX);
|
|
|
|
if (pkt == NULL)
|
|
|
|
{
|
|
|
|
vrtinfo("Has ran out of the RX buffer, i=%d\n", i);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2023-07-04 13:01:00 +02:00
|
|
|
/* Preserve data length */
|
|
|
|
|
|
|
|
if (netpkt_setdatalen(dev, pkt, VIRTIO_NET_BUFSIZE) <
|
|
|
|
VIRTIO_NET_BUFSIZE)
|
|
|
|
{
|
|
|
|
vrtwarn("No enough buffer to prepare RX buffer, i=%d\n", i);
|
|
|
|
netpkt_free(dev, pkt, NETPKT_RX);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2024-05-21 13:59:49 +02:00
|
|
|
/* Add buffer to RX virtqueue */
|
2023-03-22 04:49:43 +01:00
|
|
|
|
2024-05-21 13:59:49 +02:00
|
|
|
virtio_net_addbuffer(dev, vq, pkt, VIRTIO_NET_RX);
|
2023-03-22 04:49:43 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
if (i > 0)
|
|
|
|
{
|
|
|
|
virtqueue_kick(vq);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_txfree
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void virtio_net_txfree(FAR struct netdev_lowerhalf_s *dev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
FAR struct virtqueue *vq = priv->vdev->vrings_info[VIRTIO_NET_TX].vq;
|
|
|
|
FAR struct virtio_net_llhdr_s *hdr;
|
|
|
|
|
|
|
|
while (1)
|
|
|
|
{
|
|
|
|
/* Get buffer from tx virtqueue */
|
|
|
|
|
|
|
|
hdr = virtqueue_get_buffer(vq, NULL, NULL);
|
|
|
|
if (hdr == NULL)
|
|
|
|
{
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
netpkt_free(dev, hdr->pkt, NETPKT_TX);
|
|
|
|
vrtinfo("Free, hdr: %p, pkt: %p\n", hdr, hdr->pkt);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_ifup
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_ifup(FAR struct netdev_lowerhalf_s *dev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
|
|
|
|
#ifdef CONFIG_NET_IPv4
|
2023-08-18 22:23:01 +02:00
|
|
|
vrtinfo("Bringing up: %u.%u.%u.%u\n",
|
|
|
|
ip4_addr1(dev->netdev.d_ipaddr), ip4_addr2(dev->netdev.d_ipaddr),
|
|
|
|
ip4_addr3(dev->netdev.d_ipaddr), ip4_addr4(dev->netdev.d_ipaddr));
|
2023-03-22 04:49:43 +01:00
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_NET_IPv6
|
|
|
|
vrtinfo("Bringing up: %04x:%04x:%04x:%04x:%04x:%04x:%04x:%04x\n",
|
|
|
|
dev->netdev.d_ipv6addr[0], dev->netdev.d_ipv6addr[1],
|
|
|
|
dev->netdev.d_ipv6addr[2], dev->netdev.d_ipv6addr[3],
|
|
|
|
dev->netdev.d_ipv6addr[4], dev->netdev.d_ipv6addr[5],
|
|
|
|
dev->netdev.d_ipv6addr[6], dev->netdev.d_ipv6addr[7]);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Prepare interrupt and packets for receiving */
|
|
|
|
|
|
|
|
virtqueue_enable_cb(priv->vdev->vrings_info[VIRTIO_NET_RX].vq);
|
|
|
|
virtio_net_rxfill(dev);
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
2023-12-08 07:43:38 +01:00
|
|
|
if (priv->lower.wifi == NULL)
|
2023-10-23 08:06:12 +02:00
|
|
|
#endif
|
|
|
|
{
|
2023-12-08 07:43:38 +01:00
|
|
|
netdev_lower_carrier_on(dev);
|
2023-10-23 08:06:12 +02:00
|
|
|
}
|
2023-12-08 07:43:38 +01:00
|
|
|
|
|
|
|
return OK;
|
2023-03-22 04:49:43 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_ifdown
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_ifdown(FAR struct netdev_lowerhalf_s *dev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
int i;
|
|
|
|
|
|
|
|
/* Disable the Ethernet interrupt */
|
|
|
|
|
|
|
|
for (i = 0; i < VIRTIO_NET_NUM; i++)
|
|
|
|
{
|
|
|
|
virtqueue_disable_cb(priv->vdev->vrings_info[i].vq);
|
|
|
|
}
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
|
|
|
if (priv->lower.wifi)
|
|
|
|
{
|
|
|
|
return dev->iw_ops->disconnect(dev);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
#endif
|
|
|
|
{
|
2023-12-08 07:43:38 +01:00
|
|
|
netdev_lower_carrier_off(dev);
|
|
|
|
return OK;
|
2023-10-23 08:06:12 +02:00
|
|
|
}
|
2023-03-22 04:49:43 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_send
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_send(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR netpkt_t *pkt)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
FAR struct virtqueue *vq = priv->vdev->vrings_info[VIRTIO_NET_TX].vq;
|
|
|
|
|
|
|
|
/* Check the send length */
|
|
|
|
|
2023-07-04 13:01:00 +02:00
|
|
|
if (netpkt_getdatalen(dev, pkt) > VIRTIO_NET_BUFSIZE)
|
2023-03-22 04:49:43 +01:00
|
|
|
{
|
|
|
|
vrterr("net send buffer too large\n");
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Add buffer to vq and notify the other side */
|
|
|
|
|
2024-05-21 13:59:49 +02:00
|
|
|
virtio_net_addbuffer(dev, vq, pkt, VIRTIO_NET_TX);
|
2023-03-22 04:49:43 +01:00
|
|
|
virtqueue_kick(vq);
|
|
|
|
|
|
|
|
/* Try return Netpkt TX buffer to upper-half. */
|
|
|
|
|
|
|
|
virtio_net_txfree(dev);
|
|
|
|
|
|
|
|
/* If we have no buffer left, enable TX done callback. */
|
|
|
|
|
|
|
|
if (netdev_lower_quota_load(dev, NETPKT_TX) <= 0)
|
|
|
|
{
|
|
|
|
virtqueue_enable_cb(vq);
|
|
|
|
}
|
|
|
|
|
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_recv
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static netpkt_t *virtio_net_recv(FAR struct netdev_lowerhalf_s *dev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = (FAR struct virtio_net_priv_s *)dev;
|
|
|
|
FAR struct virtqueue *vq = priv->vdev->vrings_info[VIRTIO_NET_RX].vq;
|
|
|
|
FAR struct virtio_net_llhdr_s *hdr;
|
|
|
|
uint32_t len;
|
|
|
|
|
|
|
|
/* Fill the free Netpkt RX buffer to the RX virtqueue */
|
|
|
|
|
|
|
|
virtio_net_rxfill(dev);
|
|
|
|
|
|
|
|
/* Get received buffer form RX virtqueue */
|
|
|
|
|
|
|
|
hdr = virtqueue_get_buffer(vq, &len, NULL);
|
|
|
|
if (hdr == NULL)
|
|
|
|
{
|
|
|
|
/* If we have no buffer left, enable RX callback. */
|
|
|
|
|
|
|
|
virtqueue_enable_cb(vq);
|
|
|
|
|
|
|
|
vrtinfo("get NULL buffer\n");
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Set the received pkt length */
|
|
|
|
|
|
|
|
netpkt_setdatalen(dev, hdr->pkt, len - VIRTIO_NET_HDRSIZE);
|
|
|
|
vrtinfo("Recv, hdr=%p, pkt=%p, len=%" PRIu32 "\n", hdr, hdr->pkt, len);
|
|
|
|
return hdr->pkt;
|
|
|
|
}
|
|
|
|
|
|
|
|
#ifdef CONFIG_NET_MCASTGROUP
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_addmac
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_addmac(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR const uint8_t *mac)
|
|
|
|
{
|
|
|
|
return -ENOSYS;
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_rmmac
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_rmmac(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
FAR const uint8_t *mac)
|
|
|
|
{
|
|
|
|
return -ENOSYS;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef CONFIG_NETDEV_IOCTL
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_ioctl
|
|
|
|
****************************************************************************/
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
static int virtio_net_ioctl(FAR struct netdev_lowerhalf_s *dev,
|
|
|
|
int cmd, unsigned long arg)
|
2023-03-22 04:49:43 +01:00
|
|
|
{
|
|
|
|
return -ENOTTY;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_rxready
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void virtio_net_rxready(FAR struct virtqueue *vq)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = vq->vq_dev->priv;
|
|
|
|
|
|
|
|
virtqueue_disable_cb(vq);
|
2023-10-23 08:06:12 +02:00
|
|
|
netdev_lower_rxready((FAR struct netdev_lowerhalf_s *)priv);
|
2023-03-22 04:49:43 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_txdone
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void virtio_net_txdone(FAR struct virtqueue *vq)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = vq->vq_dev->priv;
|
|
|
|
|
|
|
|
virtqueue_disable_cb(vq);
|
2023-10-23 08:06:12 +02:00
|
|
|
netdev_lower_txdone((FAR struct netdev_lowerhalf_s *)priv);
|
2023-03-22 04:49:43 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_init
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_init(FAR struct virtio_net_priv_s *priv,
|
|
|
|
FAR struct virtio_device *vdev)
|
|
|
|
{
|
|
|
|
FAR const char *vqnames[VIRTIO_NET_NUM];
|
|
|
|
vq_callback callbacks[VIRTIO_NET_NUM];
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
priv->vdev = vdev;
|
|
|
|
vdev->priv = priv;
|
|
|
|
|
|
|
|
/* Initialize the virtio device */
|
|
|
|
|
|
|
|
virtio_set_status(vdev, VIRTIO_CONFIG_STATUS_DRIVER);
|
2024-05-21 13:59:49 +02:00
|
|
|
virtio_negotiate_features(vdev, (1UL << VIRTIO_NET_F_MAC) |
|
|
|
|
(1UL << VIRTIO_F_ANY_LAYOUT));
|
2023-03-22 04:49:43 +01:00
|
|
|
virtio_set_status(vdev, VIRTIO_CONFIG_FEATURES_OK);
|
|
|
|
|
|
|
|
vqnames[VIRTIO_NET_RX] = "virtio_net_rx";
|
|
|
|
vqnames[VIRTIO_NET_TX] = "virtio_net_tx";
|
|
|
|
callbacks[VIRTIO_NET_RX] = virtio_net_rxready;
|
|
|
|
callbacks[VIRTIO_NET_TX] = virtio_net_txdone;
|
|
|
|
ret = virtio_create_virtqueues(vdev, 0, VIRTIO_NET_NUM, vqnames,
|
|
|
|
callbacks);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
vrterr("virtio_device_create_virtqueue failed, ret=%d\n", ret);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
virtio_set_status(vdev, VIRTIO_CONFIG_STATUS_DRIVER_OK);
|
|
|
|
|
|
|
|
#if CONFIG_DRIVERS_VIRTIO_NET_BUFNUM > 0
|
|
|
|
priv->bufnum = CONFIG_DRIVERS_VIRTIO_NET_BUFNUM;
|
|
|
|
#else
|
|
|
|
/* Calculate the virtio network buffer number:
|
|
|
|
* 1/4 for the TX netpkts, 1/4 for the RX netpkts.
|
|
|
|
*/
|
|
|
|
|
2023-07-04 13:01:00 +02:00
|
|
|
priv->bufnum = CONFIG_IOB_NBUFFERS / VIRTIO_NET_MAX_NIOB / 4;
|
2023-03-22 04:49:43 +01:00
|
|
|
#endif
|
|
|
|
priv->bufnum = MIN(vdev->vrings_info[VIRTIO_NET_RX].info.num_descs,
|
|
|
|
priv->bufnum);
|
|
|
|
priv->bufnum = MIN(vdev->vrings_info[VIRTIO_NET_TX].info.num_descs,
|
|
|
|
priv->bufnum);
|
|
|
|
return OK;
|
|
|
|
}
|
|
|
|
|
2023-12-04 07:21:45 +01:00
|
|
|
static void virtio_net_set_macaddr(FAR struct virtio_net_priv_s *priv)
|
|
|
|
{
|
2023-10-23 08:06:12 +02:00
|
|
|
FAR struct net_driver_s *dev =
|
|
|
|
&((FAR struct netdev_lowerhalf_s *)&priv->lower)->netdev;
|
2023-12-04 07:21:45 +01:00
|
|
|
FAR struct virtio_device *vdev = priv->vdev;
|
|
|
|
FAR uint8_t *mac = dev->d_mac.ether.ether_addr_octet;
|
|
|
|
|
|
|
|
if (virtio_has_feature(vdev, VIRTIO_NET_F_MAC))
|
|
|
|
{
|
|
|
|
virtio_read_config(vdev, offsetof(struct virtio_net_config_s, mac),
|
|
|
|
mac, IFHWADDRLEN);
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
/* Assign a random locally-created MAC address.
|
|
|
|
*
|
|
|
|
* TODO: The generated MAC address should be checked to see if it
|
|
|
|
* conflicts with something else on the network.
|
|
|
|
*/
|
|
|
|
|
|
|
|
srand(time(NULL) +
|
|
|
|
#ifdef CONFIG_NETDEV_IFINDEX
|
|
|
|
dev->d_ifindex
|
|
|
|
#else
|
2023-12-18 10:41:54 +01:00
|
|
|
(uintptr_t)dev % 256
|
2023-12-04 07:21:45 +01:00
|
|
|
#endif
|
|
|
|
);
|
|
|
|
|
|
|
|
mac[0] = 0x42;
|
|
|
|
mac[1] = rand() % 256;
|
|
|
|
mac[2] = rand() % 256;
|
|
|
|
mac[3] = rand() % 256;
|
|
|
|
mac[4] = rand() % 256;
|
|
|
|
mac[5] = rand() % 256;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_probe
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static int virtio_net_probe(FAR struct virtio_device *vdev)
|
|
|
|
{
|
|
|
|
FAR struct netdev_lowerhalf_s *netdev;
|
|
|
|
FAR struct virtio_net_priv_s *priv;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
priv = kmm_zalloc(sizeof(*priv));
|
|
|
|
if (priv == NULL)
|
|
|
|
{
|
|
|
|
vrterr("Virtio net driver priv alloc failed\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
ret = virtio_net_init(priv, vdev);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
vrterr("virtio_net_init failed, ret=%d\n", ret);
|
|
|
|
goto err_with_priv;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initialize the netdev lower half */
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
netdev = (FAR struct netdev_lowerhalf_s *)priv;
|
2023-03-22 04:49:43 +01:00
|
|
|
netdev->quota[NETPKT_RX] = priv->bufnum;
|
|
|
|
netdev->quota[NETPKT_TX] = priv->bufnum;
|
|
|
|
netdev->ops = &g_virtio_net_ops;
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
2024-03-28 13:14:10 +01:00
|
|
|
/* If the WiFi interfaces has reached the setting value,
|
|
|
|
* no more WiFi interfaces will be created.
|
|
|
|
*/
|
|
|
|
|
|
|
|
if (g_netdev_num < CONFIG_WIFI_SIM_NUMBER)
|
2023-10-23 08:06:12 +02:00
|
|
|
{
|
2024-03-28 13:14:10 +01:00
|
|
|
ret = wifi_sim_init(&priv->lower);
|
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
goto err_with_virtqueues;
|
|
|
|
}
|
2023-10-23 08:06:12 +02:00
|
|
|
}
|
2024-03-28 13:14:10 +01:00
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
#endif
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
/* Register the net deivce */
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
ret = netdev_lower_register(netdev,
|
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
2024-03-28 13:14:10 +01:00
|
|
|
g_netdev_num++ < CONFIG_WIFI_SIM_NUMBER ?
|
|
|
|
NET_LL_IEEE80211 : NET_LL_ETHERNET
|
2023-10-23 08:06:12 +02:00
|
|
|
#else
|
|
|
|
NET_LL_ETHERNET
|
|
|
|
#endif
|
|
|
|
);
|
2023-03-22 04:49:43 +01:00
|
|
|
if (ret < 0)
|
|
|
|
{
|
|
|
|
vrterr("netdev_lower_register failed, ret=%d\n", ret);
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
|
|
|
wifi_sim_remove(&priv->lower);
|
2024-03-28 13:14:10 +01:00
|
|
|
g_netdev_num--;
|
2023-10-23 08:06:12 +02:00
|
|
|
#endif
|
2023-03-22 04:49:43 +01:00
|
|
|
goto err_with_virtqueues;
|
|
|
|
}
|
|
|
|
|
2023-12-04 07:21:45 +01:00
|
|
|
virtio_net_set_macaddr(priv);
|
|
|
|
|
2023-03-22 04:49:43 +01:00
|
|
|
return ret;
|
|
|
|
|
|
|
|
err_with_virtqueues:
|
|
|
|
virtio_reset_device(vdev);
|
|
|
|
virtio_delete_virtqueues(vdev);
|
|
|
|
err_with_priv:
|
|
|
|
kmm_free(priv);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_net_remove
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
static void virtio_net_remove(FAR struct virtio_device *vdev)
|
|
|
|
{
|
|
|
|
FAR struct virtio_net_priv_s *priv = vdev->priv;
|
|
|
|
|
2023-10-23 08:06:12 +02:00
|
|
|
netdev_lower_unregister((FAR struct netdev_lowerhalf_s *)priv);
|
2023-03-22 04:49:43 +01:00
|
|
|
virtio_reset_device(vdev);
|
|
|
|
virtio_delete_virtqueues(vdev);
|
2023-10-23 08:06:12 +02:00
|
|
|
#ifdef CONFIG_DRIVERS_WIFI_SIM
|
2024-03-28 13:14:10 +01:00
|
|
|
g_netdev_num--;
|
2023-10-23 08:06:12 +02:00
|
|
|
wifi_sim_remove(&priv->lower);
|
|
|
|
#endif
|
2023-03-22 04:49:43 +01:00
|
|
|
kmm_free(priv);
|
|
|
|
}
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Public Functions
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
/****************************************************************************
|
|
|
|
* Name: virtio_register_net_driver
|
|
|
|
****************************************************************************/
|
|
|
|
|
|
|
|
int virtio_register_net_driver(void)
|
|
|
|
{
|
|
|
|
return virtio_register_driver(&g_virtio_net_driver);
|
|
|
|
}
|