net/mlx5: add VLAN push/pop DR commands to glue
[dpdk.git] / drivers / net / octeontx2 / otx2_link.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(C) 2019 Marvell International Ltd.
3  */
4
5 #include <rte_common.h>
6 #include <rte_ethdev_pci.h>
7
8 #include "otx2_ethdev.h"
9
10 void
11 otx2_nix_toggle_flag_link_cfg(struct otx2_eth_dev *dev, bool set)
12 {
13         if (set)
14                 dev->flags |= OTX2_LINK_CFG_IN_PROGRESS_F;
15         else
16                 dev->flags &= ~OTX2_LINK_CFG_IN_PROGRESS_F;
17
18         rte_wmb();
19 }
20
21 static inline int
22 nix_wait_for_link_cfg(struct otx2_eth_dev *dev)
23 {
24         uint16_t wait = 1000;
25
26         do {
27                 rte_rmb();
28                 if (!(dev->flags & OTX2_LINK_CFG_IN_PROGRESS_F))
29                         break;
30                 wait--;
31                 rte_delay_ms(1);
32         } while (wait);
33
34         return wait ? 0 : -1;
35 }
36
37 static void
38 nix_link_status_print(struct rte_eth_dev *eth_dev, struct rte_eth_link *link)
39 {
40         if (link && link->link_status)
41                 otx2_info("Port %d: Link Up - speed %u Mbps - %s",
42                           (int)(eth_dev->data->port_id),
43                           (uint32_t)link->link_speed,
44                           link->link_duplex == ETH_LINK_FULL_DUPLEX ?
45                           "full-duplex" : "half-duplex");
46         else
47                 otx2_info("Port %d: Link Down", (int)(eth_dev->data->port_id));
48 }
49
50 void
51 otx2_eth_dev_link_status_update(struct otx2_dev *dev,
52                                 struct cgx_link_user_info *link)
53 {
54         struct otx2_eth_dev *otx2_dev = (struct otx2_eth_dev *)dev;
55         struct rte_eth_link eth_link;
56         struct rte_eth_dev *eth_dev;
57
58         if (!link || !dev)
59                 return;
60
61         eth_dev = otx2_dev->eth_dev;
62         if (!eth_dev || !eth_dev->data->dev_conf.intr_conf.lsc)
63                 return;
64
65         if (nix_wait_for_link_cfg(otx2_dev)) {
66                 otx2_err("Timeout waiting for link_cfg to complete");
67                 return;
68         }
69
70         eth_link.link_status = link->link_up;
71         eth_link.link_speed = link->speed;
72         eth_link.link_autoneg = ETH_LINK_AUTONEG;
73         eth_link.link_duplex = link->full_duplex;
74
75         /* Print link info */
76         nix_link_status_print(eth_dev, &eth_link);
77
78         /* Update link info */
79         rte_eth_linkstatus_set(eth_dev, &eth_link);
80
81         /* Set the flag and execute application callbacks */
82         _rte_eth_dev_callback_process(eth_dev, RTE_ETH_EVENT_INTR_LSC, NULL);
83 }
84
85 int
86 otx2_nix_link_update(struct rte_eth_dev *eth_dev, int wait_to_complete)
87 {
88         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
89         struct otx2_mbox *mbox = dev->mbox;
90         struct cgx_link_info_msg *rsp;
91         struct rte_eth_link link;
92         int rc;
93
94         RTE_SET_USED(wait_to_complete);
95
96         if (otx2_dev_is_lbk(dev))
97                 return 0;
98
99         otx2_mbox_alloc_msg_cgx_get_linkinfo(mbox);
100         rc = otx2_mbox_process_msg(mbox, (void *)&rsp);
101         if (rc)
102                 return rc;
103
104         link.link_status = rsp->link_info.link_up;
105         link.link_speed = rsp->link_info.speed;
106         link.link_autoneg = ETH_LINK_AUTONEG;
107
108         if (rsp->link_info.full_duplex)
109                 link.link_duplex = rsp->link_info.full_duplex;
110
111         return rte_eth_linkstatus_set(eth_dev, &link);
112 }
113
114 static int
115 nix_dev_set_link_state(struct rte_eth_dev *eth_dev, uint8_t enable)
116 {
117         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
118         struct otx2_mbox *mbox = dev->mbox;
119         struct cgx_set_link_state_msg *req;
120
121         req = otx2_mbox_alloc_msg_cgx_set_link_state(mbox);
122         req->enable = enable;
123         return otx2_mbox_process(mbox);
124 }
125
126 int
127 otx2_nix_dev_set_link_up(struct rte_eth_dev *eth_dev)
128 {
129         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
130         int rc, i;
131
132         if (otx2_dev_is_vf(dev))
133                 return -ENOTSUP;
134
135         rc = nix_dev_set_link_state(eth_dev, 1);
136         if (rc)
137                 goto done;
138
139         /* Start tx queues  */
140         for (i = 0; i < eth_dev->data->nb_tx_queues; i++)
141                 otx2_nix_tx_queue_start(eth_dev, i);
142
143 done:
144         return rc;
145 }
146
147 int
148 otx2_nix_dev_set_link_down(struct rte_eth_dev *eth_dev)
149 {
150         struct otx2_eth_dev *dev = otx2_eth_pmd_priv(eth_dev);
151         int i;
152
153         if (otx2_dev_is_vf(dev))
154                 return -ENOTSUP;
155
156         /* Stop tx queues  */
157         for (i = 0; i < eth_dev->data->nb_tx_queues; i++)
158                 otx2_nix_tx_queue_stop(eth_dev, i);
159
160         return nix_dev_set_link_state(eth_dev, 0);
161 }