/*
* Copyright (c) 2018 Intel Corporation.
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <logging/log.h>
LOG_MODULE_REGISTER(net_ethernet_mgmt, CONFIG_NET_L2_ETHERNET_LOG_LEVEL);
#include <errno.h>
#include <net/net_core.h>
#include <net/net_if.h>
#include <net/ethernet_mgmt.h>
static inline bool is_hw_caps_supported(struct device *dev,
enum ethernet_hw_caps caps)
{
const struct ethernet_api *api = dev->driver_api;
if (!api) {
return false;
}
return !!(api->get_capabilities(dev) & caps);
}
static int ethernet_set_config(u32_t mgmt_request,
struct net_if *iface,
void *data, size_t len)
{
struct ethernet_req_params *params = (struct ethernet_req_params *)data;
struct device *dev = net_if_get_device(iface);
const struct ethernet_api *api = dev->driver_api;
struct ethernet_config config = { 0 };
enum ethernet_config_type type;
if (!api) {
return -ENOENT;
}
if (!api->set_config) {
return -ENOTSUP;
}
if (!data || (len != sizeof(struct ethernet_req_params))) {
return -EINVAL;
}
if (mgmt_request == NET_REQUEST_ETHERNET_SET_AUTO_NEGOTIATION) {
if (!is_hw_caps_supported(dev,
ETHERNET_AUTO_NEGOTIATION_SET)) {
return -ENOTSUP;
}
config.auto_negotiation = params->auto_negotiation;
type = ETHERNET_CONFIG_TYPE_AUTO_NEG;
} else if (mgmt_request == NET_REQUEST_ETHERNET_SET_LINK) {
type = ETHERNET_CONFIG_TYPE_LINK;
if (params->l.link_10bt) {
if (!is_hw_caps_supported(dev,
ETHERNET_LINK_10BASE_T)) {
return -ENOTSUP;
}
config.l.link_10bt = true;
} else if (params->l.link_100bt) {
if (!is_hw_caps_supported(dev,
ETHERNET_LINK_100BASE_T)) {
return -ENOTSUP;
}
config.l.link_100bt = true;
} else if (params->l.link_1000bt) {
if (!is_hw_caps_supported(dev,
ETHERNET_LINK_1000BASE_T)) {
return -ENOTSUP;
}
config.l.link_1000bt = true;
} else {
return -EINVAL;
}
type = ETHERNET_CONFIG_TYPE_LINK;
} else if (mgmt_request == NET_REQUEST_ETHERNET_SET_DUPLEX) {
if (!is_hw_caps_supported(dev, ETHERNET_DUPLEX_SET)) {
return -ENOTSUP;
}
config.full_duplex = params->full_duplex;
type = ETHERNET_CONFIG_TYPE_DUPLEX;
} else if (mgmt_request == NET_REQUEST_ETHERNET_SET_MAC_ADDRESS) {
if (net_if_is_up(iface)) {
return -EACCES;
}
/* We need to remove the old IPv6 link layer address, that is
* generated from old MAC address, from network interface if
* needed.
*/
if (IS_ENABLED(CONFIG_NET_IPV6)) {
struct in6_addr iid;
net_ipv6_addr_create_iid(&iid,
net_if_get_link_addr(iface));
/* No need to check the return value in this case. It
* is not an error if the address is not found atm.
*/
(void)net_if_ipv6_addr_rm(iface, &iid);
}
memcpy(&config.mac_address, ¶ms->mac_address,
sizeof(struct net_eth_addr));
type = ETHERNET_CONFIG_TYPE_MAC_ADDRESS;
} else if (mgmt_request == NET_REQUEST_ETHERNET_SET_QAV_PARAM) {
if (!is_hw_caps_supported(dev, ETHERNET_QAV)) {
return -ENOTSUP;
}
/* Validate params which need global validating */
switch (params->qav_param.type) {
case ETHERNET_QAV_PARAM_TYPE_DELTA_BANDWIDTH:
if (params->qav_param.delta_bandwidth > 100) {
return -EINVAL;
}
break;
case ETHERNET_QAV_PARAM_TYPE_OPER_IDLE_SLOPE:
case ETHERNET_QAV_PARAM_TYPE_TRAFFIC_CLASS:
/* Read-only parameters */
return -EINVAL;
default:
/* No validation needed */
break;
}
memcpy(&config.qav_param, ¶ms->qav_param,
sizeof(struct ethernet_qav_param));
type = ETHERNET_CONFIG_TYPE_QAV_PARAM;
} else if (mgmt_request == NET_REQUEST_ETHERNET_SET_PROMISC_MODE) {
if (!is_hw_caps_supported(dev, ETHERNET_PROMISC_MODE)) {
return -ENOTSUP;
}
config.promisc_mode = params->promisc_mode;
type = ETHERNET_CONFIG_TYPE_PROMISC_MODE;
} else {
return -EINVAL;
}
return api->set_config(net_if_get_device(iface), type, &config);
}
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_AUTO_NEGOTIATION,
ethernet_set_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_LINK,
ethernet_set_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_DUPLEX,
ethernet_set_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_MAC_ADDRESS,
ethernet_set_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_QAV_PARAM,
ethernet_set_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_SET_PROMISC_MODE,
ethernet_set_config);
static int ethernet_get_config(u32_t mgmt_request,
struct net_if *iface,
void *data, size_t len)
{
struct ethernet_req_params *params = (struct ethernet_req_params *)data;
struct device *dev = net_if_get_device(iface);
const struct ethernet_api *api = dev->driver_api;
struct ethernet_config config = { 0 };
int ret = 0;
enum ethernet_config_type type;
if (!api) {
return -ENOENT;
}
if (!api->get_config) {
return -ENOTSUP;
}
if (!data || (len != sizeof(struct ethernet_req_params))) {
return -EINVAL;
}
if (mgmt_request == NET_REQUEST_ETHERNET_GET_PRIORITY_QUEUES_NUM) {
if (!is_hw_caps_supported(dev, ETHERNET_PRIORITY_QUEUES)) {
return -ENOTSUP;
}
type = ETHERNET_CONFIG_TYPE_PRIORITY_QUEUES_NUM;
ret = api->get_config(dev, type, &config);
if (ret) {
return ret;
}
params->priority_queues_num = config.priority_queues_num;
} else if (mgmt_request == NET_REQUEST_ETHERNET_GET_QAV_PARAM) {
if (!is_hw_caps_supported(dev, ETHERNET_QAV)) {
return -ENOTSUP;
}
config.qav_param.queue_id = params->qav_param.queue_id;
config.qav_param.type = params->qav_param.type;
type = ETHERNET_CONFIG_TYPE_QAV_PARAM;
ret = api->get_config(dev, type, &config);
if (ret) {
return ret;
}
switch (config.qav_param.type) {
case ETHERNET_QAV_PARAM_TYPE_DELTA_BANDWIDTH:
params->qav_param.delta_bandwidth =
config.qav_param.delta_bandwidth;
break;
case ETHERNET_QAV_PARAM_TYPE_IDLE_SLOPE:
params->qav_param.idle_slope =
config.qav_param.idle_slope;
break;
case ETHERNET_QAV_PARAM_TYPE_OPER_IDLE_SLOPE:
params->qav_param.oper_idle_slope =
config.qav_param.oper_idle_slope;
break;
case ETHERNET_QAV_PARAM_TYPE_TRAFFIC_CLASS:
params->qav_param.traffic_class =
config.qav_param.traffic_class;
break;
case ETHERNET_QAV_PARAM_TYPE_STATUS:
params->qav_param.enabled = config.qav_param.enabled;
break;
}
} else {
return -EINVAL;
}
return ret;
}
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_GET_PRIORITY_QUEUES_NUM,
ethernet_get_config);
NET_MGMT_REGISTER_REQUEST_HANDLER(NET_REQUEST_ETHERNET_GET_QAV_PARAM,
ethernet_get_config);
void ethernet_mgmt_raise_carrier_on_event(struct net_if *iface)
{
net_mgmt_event_notify(NET_EVENT_ETHERNET_CARRIER_ON, iface);
}
void ethernet_mgmt_raise_carrier_off_event(struct net_if *iface)
{
net_mgmt_event_notify(NET_EVENT_ETHERNET_CARRIER_OFF, iface);
}
void ethernet_mgmt_raise_vlan_enabled_event(struct net_if *iface, u16_t tag)
{
#if defined(CONFIG_NET_MGMT_EVENT_INFO)
net_mgmt_event_notify_with_info(NET_EVENT_ETHERNET_VLAN_TAG_ENABLED,
iface, &tag, sizeof(tag));
#else
net_mgmt_event_notify(NET_EVENT_ETHERNET_VLAN_TAG_ENABLED,
iface);
#endif
}
void ethernet_mgmt_raise_vlan_disabled_event(struct net_if *iface, u16_t tag)
{
#if defined(CONFIG_NET_MGMT_EVENT_INFO)
net_mgmt_event_notify_with_info(NET_EVENT_ETHERNET_VLAN_TAG_DISABLED,
iface, &tag, sizeof(tag));
#else
net_mgmt_event_notify(NET_EVENT_ETHERNET_VLAN_TAG_DISABLED, iface);
#endif
}