xref: /f-stack/dpdk/drivers/net/ionic/ionic_dev.c (revision 2d9fd380)
1*2d9fd380Sjfb8856606 /* SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0)
2*2d9fd380Sjfb8856606  * Copyright(c) 2018-2019 Pensando Systems, Inc. All rights reserved.
3*2d9fd380Sjfb8856606  */
4*2d9fd380Sjfb8856606 
5*2d9fd380Sjfb8856606 #include <stdbool.h>
6*2d9fd380Sjfb8856606 
7*2d9fd380Sjfb8856606 #include <rte_malloc.h>
8*2d9fd380Sjfb8856606 
9*2d9fd380Sjfb8856606 #include "ionic_dev.h"
10*2d9fd380Sjfb8856606 #include "ionic_lif.h"
11*2d9fd380Sjfb8856606 #include "ionic.h"
12*2d9fd380Sjfb8856606 
13*2d9fd380Sjfb8856606 int
ionic_dev_setup(struct ionic_adapter * adapter)14*2d9fd380Sjfb8856606 ionic_dev_setup(struct ionic_adapter *adapter)
15*2d9fd380Sjfb8856606 {
16*2d9fd380Sjfb8856606 	struct ionic_dev_bar *bar = adapter->bars;
17*2d9fd380Sjfb8856606 	unsigned int num_bars = adapter->num_bars;
18*2d9fd380Sjfb8856606 	struct ionic_dev *idev = &adapter->idev;
19*2d9fd380Sjfb8856606 	uint32_t sig;
20*2d9fd380Sjfb8856606 	u_char *bar0_base;
21*2d9fd380Sjfb8856606 	unsigned int i;
22*2d9fd380Sjfb8856606 
23*2d9fd380Sjfb8856606 	/* BAR0: dev_cmd and interrupts */
24*2d9fd380Sjfb8856606 	if (num_bars < 1) {
25*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR, "No bars found, aborting");
26*2d9fd380Sjfb8856606 		return -EFAULT;
27*2d9fd380Sjfb8856606 	}
28*2d9fd380Sjfb8856606 
29*2d9fd380Sjfb8856606 	if (bar->len < IONIC_BAR0_SIZE) {
30*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR,
31*2d9fd380Sjfb8856606 			"Resource bar size %lu too small, aborting",
32*2d9fd380Sjfb8856606 			bar->len);
33*2d9fd380Sjfb8856606 		return -EFAULT;
34*2d9fd380Sjfb8856606 	}
35*2d9fd380Sjfb8856606 
36*2d9fd380Sjfb8856606 	bar0_base = bar->vaddr;
37*2d9fd380Sjfb8856606 	idev->dev_info = (union ionic_dev_info_regs *)
38*2d9fd380Sjfb8856606 		&bar0_base[IONIC_BAR0_DEV_INFO_REGS_OFFSET];
39*2d9fd380Sjfb8856606 	idev->dev_cmd = (union ionic_dev_cmd_regs *)
40*2d9fd380Sjfb8856606 		&bar0_base[IONIC_BAR0_DEV_CMD_REGS_OFFSET];
41*2d9fd380Sjfb8856606 	idev->intr_status = (struct ionic_intr_status *)
42*2d9fd380Sjfb8856606 		&bar0_base[IONIC_BAR0_INTR_STATUS_OFFSET];
43*2d9fd380Sjfb8856606 	idev->intr_ctrl = (struct ionic_intr *)
44*2d9fd380Sjfb8856606 		&bar0_base[IONIC_BAR0_INTR_CTRL_OFFSET];
45*2d9fd380Sjfb8856606 
46*2d9fd380Sjfb8856606 	sig = ioread32(&idev->dev_info->signature);
47*2d9fd380Sjfb8856606 	if (sig != IONIC_DEV_INFO_SIGNATURE) {
48*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR, "Incompatible firmware signature %" PRIx32 "",
49*2d9fd380Sjfb8856606 			sig);
50*2d9fd380Sjfb8856606 		return -EFAULT;
51*2d9fd380Sjfb8856606 	}
52*2d9fd380Sjfb8856606 
53*2d9fd380Sjfb8856606 	for (i = 0; i < IONIC_DEVINFO_FWVERS_BUFLEN; i++)
54*2d9fd380Sjfb8856606 		adapter->fw_version[i] =
55*2d9fd380Sjfb8856606 			ioread8(&idev->dev_info->fw_version[i]);
56*2d9fd380Sjfb8856606 	adapter->fw_version[IONIC_DEVINFO_FWVERS_BUFLEN - 1] = '\0';
57*2d9fd380Sjfb8856606 
58*2d9fd380Sjfb8856606 	IONIC_PRINT(DEBUG, "Firmware version: %s", adapter->fw_version);
59*2d9fd380Sjfb8856606 
60*2d9fd380Sjfb8856606 	/* BAR1: doorbells */
61*2d9fd380Sjfb8856606 	bar++;
62*2d9fd380Sjfb8856606 	if (num_bars < 2) {
63*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR, "Doorbell bar missing, aborting");
64*2d9fd380Sjfb8856606 		return -EFAULT;
65*2d9fd380Sjfb8856606 	}
66*2d9fd380Sjfb8856606 
67*2d9fd380Sjfb8856606 	idev->db_pages = bar->vaddr;
68*2d9fd380Sjfb8856606 	idev->phy_db_pages = bar->bus_addr;
69*2d9fd380Sjfb8856606 
70*2d9fd380Sjfb8856606 	return 0;
71*2d9fd380Sjfb8856606 }
72*2d9fd380Sjfb8856606 
73*2d9fd380Sjfb8856606 /* Devcmd Interface */
74*2d9fd380Sjfb8856606 
75*2d9fd380Sjfb8856606 uint8_t
ionic_dev_cmd_status(struct ionic_dev * idev)76*2d9fd380Sjfb8856606 ionic_dev_cmd_status(struct ionic_dev *idev)
77*2d9fd380Sjfb8856606 {
78*2d9fd380Sjfb8856606 	return ioread8(&idev->dev_cmd->comp.comp.status);
79*2d9fd380Sjfb8856606 }
80*2d9fd380Sjfb8856606 
81*2d9fd380Sjfb8856606 bool
ionic_dev_cmd_done(struct ionic_dev * idev)82*2d9fd380Sjfb8856606 ionic_dev_cmd_done(struct ionic_dev *idev)
83*2d9fd380Sjfb8856606 {
84*2d9fd380Sjfb8856606 	return ioread32(&idev->dev_cmd->done) & IONIC_DEV_CMD_DONE;
85*2d9fd380Sjfb8856606 }
86*2d9fd380Sjfb8856606 
87*2d9fd380Sjfb8856606 void
ionic_dev_cmd_comp(struct ionic_dev * idev,void * mem)88*2d9fd380Sjfb8856606 ionic_dev_cmd_comp(struct ionic_dev *idev, void *mem)
89*2d9fd380Sjfb8856606 {
90*2d9fd380Sjfb8856606 	union ionic_dev_cmd_comp *comp = mem;
91*2d9fd380Sjfb8856606 	unsigned int i;
92*2d9fd380Sjfb8856606 	uint32_t comp_size = sizeof(comp->words) /
93*2d9fd380Sjfb8856606 		sizeof(comp->words[0]);
94*2d9fd380Sjfb8856606 
95*2d9fd380Sjfb8856606 	for (i = 0; i < comp_size; i++)
96*2d9fd380Sjfb8856606 		comp->words[i] = ioread32(&idev->dev_cmd->comp.words[i]);
97*2d9fd380Sjfb8856606 }
98*2d9fd380Sjfb8856606 
99*2d9fd380Sjfb8856606 void
ionic_dev_cmd_go(struct ionic_dev * idev,union ionic_dev_cmd * cmd)100*2d9fd380Sjfb8856606 ionic_dev_cmd_go(struct ionic_dev *idev, union ionic_dev_cmd *cmd)
101*2d9fd380Sjfb8856606 {
102*2d9fd380Sjfb8856606 	unsigned int i;
103*2d9fd380Sjfb8856606 	uint32_t cmd_size = sizeof(cmd->words) /
104*2d9fd380Sjfb8856606 		sizeof(cmd->words[0]);
105*2d9fd380Sjfb8856606 
106*2d9fd380Sjfb8856606 	for (i = 0; i < cmd_size; i++)
107*2d9fd380Sjfb8856606 		iowrite32(cmd->words[i], &idev->dev_cmd->cmd.words[i]);
108*2d9fd380Sjfb8856606 
109*2d9fd380Sjfb8856606 	iowrite32(0, &idev->dev_cmd->done);
110*2d9fd380Sjfb8856606 	iowrite32(1, &idev->dev_cmd->doorbell);
111*2d9fd380Sjfb8856606 }
112*2d9fd380Sjfb8856606 
113*2d9fd380Sjfb8856606 /* Device commands */
114*2d9fd380Sjfb8856606 
115*2d9fd380Sjfb8856606 void
ionic_dev_cmd_identify(struct ionic_dev * idev,uint8_t ver)116*2d9fd380Sjfb8856606 ionic_dev_cmd_identify(struct ionic_dev *idev, uint8_t ver)
117*2d9fd380Sjfb8856606 {
118*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
119*2d9fd380Sjfb8856606 		.identify.opcode = IONIC_CMD_IDENTIFY,
120*2d9fd380Sjfb8856606 		.identify.ver = ver,
121*2d9fd380Sjfb8856606 	};
122*2d9fd380Sjfb8856606 
123*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
124*2d9fd380Sjfb8856606 }
125*2d9fd380Sjfb8856606 
126*2d9fd380Sjfb8856606 void
ionic_dev_cmd_init(struct ionic_dev * idev)127*2d9fd380Sjfb8856606 ionic_dev_cmd_init(struct ionic_dev *idev)
128*2d9fd380Sjfb8856606 {
129*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
130*2d9fd380Sjfb8856606 		.init.opcode = IONIC_CMD_INIT,
131*2d9fd380Sjfb8856606 		.init.type = 0,
132*2d9fd380Sjfb8856606 	};
133*2d9fd380Sjfb8856606 
134*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
135*2d9fd380Sjfb8856606 }
136*2d9fd380Sjfb8856606 
137*2d9fd380Sjfb8856606 void
ionic_dev_cmd_reset(struct ionic_dev * idev)138*2d9fd380Sjfb8856606 ionic_dev_cmd_reset(struct ionic_dev *idev)
139*2d9fd380Sjfb8856606 {
140*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
141*2d9fd380Sjfb8856606 		.reset.opcode = IONIC_CMD_RESET,
142*2d9fd380Sjfb8856606 	};
143*2d9fd380Sjfb8856606 
144*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
145*2d9fd380Sjfb8856606 }
146*2d9fd380Sjfb8856606 
147*2d9fd380Sjfb8856606 /* Port commands */
148*2d9fd380Sjfb8856606 
149*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_identify(struct ionic_dev * idev)150*2d9fd380Sjfb8856606 ionic_dev_cmd_port_identify(struct ionic_dev *idev)
151*2d9fd380Sjfb8856606 {
152*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
153*2d9fd380Sjfb8856606 		.port_init.opcode = IONIC_CMD_PORT_IDENTIFY,
154*2d9fd380Sjfb8856606 		.port_init.index = 0,
155*2d9fd380Sjfb8856606 	};
156*2d9fd380Sjfb8856606 
157*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
158*2d9fd380Sjfb8856606 }
159*2d9fd380Sjfb8856606 
160*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_init(struct ionic_dev * idev)161*2d9fd380Sjfb8856606 ionic_dev_cmd_port_init(struct ionic_dev *idev)
162*2d9fd380Sjfb8856606 {
163*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
164*2d9fd380Sjfb8856606 		.port_init.opcode = IONIC_CMD_PORT_INIT,
165*2d9fd380Sjfb8856606 		.port_init.index = 0,
166*2d9fd380Sjfb8856606 		.port_init.info_pa = idev->port_info_pa,
167*2d9fd380Sjfb8856606 	};
168*2d9fd380Sjfb8856606 
169*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
170*2d9fd380Sjfb8856606 }
171*2d9fd380Sjfb8856606 
172*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_reset(struct ionic_dev * idev)173*2d9fd380Sjfb8856606 ionic_dev_cmd_port_reset(struct ionic_dev *idev)
174*2d9fd380Sjfb8856606 {
175*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
176*2d9fd380Sjfb8856606 		.port_reset.opcode = IONIC_CMD_PORT_RESET,
177*2d9fd380Sjfb8856606 		.port_reset.index = 0,
178*2d9fd380Sjfb8856606 	};
179*2d9fd380Sjfb8856606 
180*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
181*2d9fd380Sjfb8856606 }
182*2d9fd380Sjfb8856606 
183*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_state(struct ionic_dev * idev,uint8_t state)184*2d9fd380Sjfb8856606 ionic_dev_cmd_port_state(struct ionic_dev *idev, uint8_t state)
185*2d9fd380Sjfb8856606 {
186*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
187*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
188*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
189*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_STATE,
190*2d9fd380Sjfb8856606 		.port_setattr.state = state,
191*2d9fd380Sjfb8856606 	};
192*2d9fd380Sjfb8856606 
193*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
194*2d9fd380Sjfb8856606 }
195*2d9fd380Sjfb8856606 
196*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_speed(struct ionic_dev * idev,uint32_t speed)197*2d9fd380Sjfb8856606 ionic_dev_cmd_port_speed(struct ionic_dev *idev, uint32_t speed)
198*2d9fd380Sjfb8856606 {
199*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
200*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
201*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
202*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_SPEED,
203*2d9fd380Sjfb8856606 		.port_setattr.speed = speed,
204*2d9fd380Sjfb8856606 	};
205*2d9fd380Sjfb8856606 
206*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
207*2d9fd380Sjfb8856606 }
208*2d9fd380Sjfb8856606 
209*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_mtu(struct ionic_dev * idev,uint32_t mtu)210*2d9fd380Sjfb8856606 ionic_dev_cmd_port_mtu(struct ionic_dev *idev, uint32_t mtu)
211*2d9fd380Sjfb8856606 {
212*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
213*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
214*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
215*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_MTU,
216*2d9fd380Sjfb8856606 		.port_setattr.mtu = mtu,
217*2d9fd380Sjfb8856606 	};
218*2d9fd380Sjfb8856606 
219*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
220*2d9fd380Sjfb8856606 }
221*2d9fd380Sjfb8856606 
222*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_autoneg(struct ionic_dev * idev,uint8_t an_enable)223*2d9fd380Sjfb8856606 ionic_dev_cmd_port_autoneg(struct ionic_dev *idev, uint8_t an_enable)
224*2d9fd380Sjfb8856606 {
225*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
226*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
227*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
228*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_AUTONEG,
229*2d9fd380Sjfb8856606 		.port_setattr.an_enable = an_enable,
230*2d9fd380Sjfb8856606 	};
231*2d9fd380Sjfb8856606 
232*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
233*2d9fd380Sjfb8856606 }
234*2d9fd380Sjfb8856606 
235*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_fec(struct ionic_dev * idev,uint8_t fec_type)236*2d9fd380Sjfb8856606 ionic_dev_cmd_port_fec(struct ionic_dev *idev, uint8_t fec_type)
237*2d9fd380Sjfb8856606 {
238*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
239*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
240*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
241*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_FEC,
242*2d9fd380Sjfb8856606 		.port_setattr.fec_type = fec_type,
243*2d9fd380Sjfb8856606 	};
244*2d9fd380Sjfb8856606 
245*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
246*2d9fd380Sjfb8856606 }
247*2d9fd380Sjfb8856606 
248*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_pause(struct ionic_dev * idev,uint8_t pause_type)249*2d9fd380Sjfb8856606 ionic_dev_cmd_port_pause(struct ionic_dev *idev, uint8_t pause_type)
250*2d9fd380Sjfb8856606 {
251*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
252*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
253*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
254*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_PAUSE,
255*2d9fd380Sjfb8856606 		.port_setattr.pause_type = pause_type,
256*2d9fd380Sjfb8856606 	};
257*2d9fd380Sjfb8856606 
258*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
259*2d9fd380Sjfb8856606 }
260*2d9fd380Sjfb8856606 
261*2d9fd380Sjfb8856606 void
ionic_dev_cmd_port_loopback(struct ionic_dev * idev,uint8_t loopback_mode)262*2d9fd380Sjfb8856606 ionic_dev_cmd_port_loopback(struct ionic_dev *idev, uint8_t loopback_mode)
263*2d9fd380Sjfb8856606 {
264*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
265*2d9fd380Sjfb8856606 		.port_setattr.opcode = IONIC_CMD_PORT_SETATTR,
266*2d9fd380Sjfb8856606 		.port_setattr.index = 0,
267*2d9fd380Sjfb8856606 		.port_setattr.attr = IONIC_PORT_ATTR_LOOPBACK,
268*2d9fd380Sjfb8856606 		.port_setattr.loopback_mode = loopback_mode,
269*2d9fd380Sjfb8856606 	};
270*2d9fd380Sjfb8856606 
271*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
272*2d9fd380Sjfb8856606 }
273*2d9fd380Sjfb8856606 
274*2d9fd380Sjfb8856606 /* LIF commands */
275*2d9fd380Sjfb8856606 
276*2d9fd380Sjfb8856606 void
ionic_dev_cmd_lif_identify(struct ionic_dev * idev,uint8_t type,uint8_t ver)277*2d9fd380Sjfb8856606 ionic_dev_cmd_lif_identify(struct ionic_dev *idev, uint8_t type, uint8_t ver)
278*2d9fd380Sjfb8856606 {
279*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
280*2d9fd380Sjfb8856606 		.lif_identify.opcode = IONIC_CMD_LIF_IDENTIFY,
281*2d9fd380Sjfb8856606 		.lif_identify.type = type,
282*2d9fd380Sjfb8856606 		.lif_identify.ver = ver,
283*2d9fd380Sjfb8856606 	};
284*2d9fd380Sjfb8856606 
285*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
286*2d9fd380Sjfb8856606 }
287*2d9fd380Sjfb8856606 
288*2d9fd380Sjfb8856606 void
ionic_dev_cmd_lif_init(struct ionic_dev * idev,uint16_t lif_index,rte_iova_t info_pa)289*2d9fd380Sjfb8856606 ionic_dev_cmd_lif_init(struct ionic_dev *idev, uint16_t lif_index,
290*2d9fd380Sjfb8856606 		       rte_iova_t info_pa)
291*2d9fd380Sjfb8856606 {
292*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
293*2d9fd380Sjfb8856606 		.lif_init.opcode = IONIC_CMD_LIF_INIT,
294*2d9fd380Sjfb8856606 		.lif_init.index = lif_index,
295*2d9fd380Sjfb8856606 		.lif_init.info_pa = info_pa,
296*2d9fd380Sjfb8856606 	};
297*2d9fd380Sjfb8856606 
298*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
299*2d9fd380Sjfb8856606 }
300*2d9fd380Sjfb8856606 
301*2d9fd380Sjfb8856606 void
ionic_dev_cmd_lif_reset(struct ionic_dev * idev,uint16_t lif_index)302*2d9fd380Sjfb8856606 ionic_dev_cmd_lif_reset(struct ionic_dev *idev, uint16_t lif_index)
303*2d9fd380Sjfb8856606 {
304*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
305*2d9fd380Sjfb8856606 		.lif_init.opcode = IONIC_CMD_LIF_RESET,
306*2d9fd380Sjfb8856606 		.lif_init.index = lif_index,
307*2d9fd380Sjfb8856606 	};
308*2d9fd380Sjfb8856606 
309*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
310*2d9fd380Sjfb8856606 }
311*2d9fd380Sjfb8856606 
312*2d9fd380Sjfb8856606 struct ionic_doorbell *
ionic_db_map(struct ionic_lif * lif,struct ionic_queue * q)313*2d9fd380Sjfb8856606 ionic_db_map(struct ionic_lif *lif, struct ionic_queue *q)
314*2d9fd380Sjfb8856606 {
315*2d9fd380Sjfb8856606 	return lif->kern_dbpage + q->hw_type;
316*2d9fd380Sjfb8856606 }
317*2d9fd380Sjfb8856606 
318*2d9fd380Sjfb8856606 int
ionic_db_page_num(struct ionic_lif * lif,int pid)319*2d9fd380Sjfb8856606 ionic_db_page_num(struct ionic_lif *lif, int pid)
320*2d9fd380Sjfb8856606 {
321*2d9fd380Sjfb8856606 	return (lif->index * 0) + pid;
322*2d9fd380Sjfb8856606 }
323*2d9fd380Sjfb8856606 
324*2d9fd380Sjfb8856606 void
ionic_intr_init(struct ionic_dev * idev,struct ionic_intr_info * intr,unsigned long index)325*2d9fd380Sjfb8856606 ionic_intr_init(struct ionic_dev *idev, struct ionic_intr_info *intr,
326*2d9fd380Sjfb8856606 		unsigned long index)
327*2d9fd380Sjfb8856606 {
328*2d9fd380Sjfb8856606 	ionic_intr_clean(idev->intr_ctrl, index);
329*2d9fd380Sjfb8856606 	intr->index = index;
330*2d9fd380Sjfb8856606 }
331*2d9fd380Sjfb8856606 
332*2d9fd380Sjfb8856606 void
ionic_dev_cmd_adminq_init(struct ionic_dev * idev,struct ionic_qcq * qcq,uint16_t lif_index,uint16_t intr_index)333*2d9fd380Sjfb8856606 ionic_dev_cmd_adminq_init(struct ionic_dev *idev,
334*2d9fd380Sjfb8856606 		struct ionic_qcq *qcq,
335*2d9fd380Sjfb8856606 		uint16_t lif_index, uint16_t intr_index)
336*2d9fd380Sjfb8856606 {
337*2d9fd380Sjfb8856606 	struct ionic_queue *q = &qcq->q;
338*2d9fd380Sjfb8856606 	struct ionic_cq *cq = &qcq->cq;
339*2d9fd380Sjfb8856606 
340*2d9fd380Sjfb8856606 	union ionic_dev_cmd cmd = {
341*2d9fd380Sjfb8856606 		.q_init.opcode = IONIC_CMD_Q_INIT,
342*2d9fd380Sjfb8856606 		.q_init.lif_index = lif_index,
343*2d9fd380Sjfb8856606 		.q_init.type = q->type,
344*2d9fd380Sjfb8856606 		.q_init.index = q->index,
345*2d9fd380Sjfb8856606 		.q_init.flags = IONIC_QINIT_F_ENA,
346*2d9fd380Sjfb8856606 		.q_init.pid = q->pid,
347*2d9fd380Sjfb8856606 		.q_init.intr_index = intr_index,
348*2d9fd380Sjfb8856606 		.q_init.ring_size = rte_log2_u32(q->num_descs),
349*2d9fd380Sjfb8856606 		.q_init.ring_base = q->base_pa,
350*2d9fd380Sjfb8856606 		.q_init.cq_ring_base = cq->base_pa,
351*2d9fd380Sjfb8856606 	};
352*2d9fd380Sjfb8856606 
353*2d9fd380Sjfb8856606 	ionic_dev_cmd_go(idev, &cmd);
354*2d9fd380Sjfb8856606 }
355*2d9fd380Sjfb8856606 
356*2d9fd380Sjfb8856606 int
ionic_cq_init(struct ionic_lif * lif,struct ionic_cq * cq,struct ionic_intr_info * intr,uint32_t num_descs,size_t desc_size)357*2d9fd380Sjfb8856606 ionic_cq_init(struct ionic_lif *lif, struct ionic_cq *cq,
358*2d9fd380Sjfb8856606 		struct ionic_intr_info *intr,
359*2d9fd380Sjfb8856606 		uint32_t num_descs, size_t desc_size)
360*2d9fd380Sjfb8856606 {
361*2d9fd380Sjfb8856606 	if (desc_size == 0) {
362*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR, "Descriptor size is %zu", desc_size);
363*2d9fd380Sjfb8856606 		return -EINVAL;
364*2d9fd380Sjfb8856606 	}
365*2d9fd380Sjfb8856606 
366*2d9fd380Sjfb8856606 	if (!rte_is_power_of_2(num_descs) ||
367*2d9fd380Sjfb8856606 	    num_descs < IONIC_MIN_RING_DESC ||
368*2d9fd380Sjfb8856606 	    num_descs > IONIC_MAX_RING_DESC) {
369*2d9fd380Sjfb8856606 		IONIC_PRINT(ERR, "%u descriptors (min: %u max: %u)",
370*2d9fd380Sjfb8856606 			num_descs, IONIC_MIN_RING_DESC, IONIC_MAX_RING_DESC);
371*2d9fd380Sjfb8856606 		return -EINVAL;
372*2d9fd380Sjfb8856606 	}
373*2d9fd380Sjfb8856606 
374*2d9fd380Sjfb8856606 	cq->lif = lif;
375*2d9fd380Sjfb8856606 	cq->bound_intr = intr;
376*2d9fd380Sjfb8856606 	cq->num_descs = num_descs;
377*2d9fd380Sjfb8856606 	cq->desc_size = desc_size;
378*2d9fd380Sjfb8856606 	cq->tail_idx = 0;
379*2d9fd380Sjfb8856606 	cq->done_color = 1;
380*2d9fd380Sjfb8856606 
381*2d9fd380Sjfb8856606 	return 0;
382*2d9fd380Sjfb8856606 }
383*2d9fd380Sjfb8856606 
384*2d9fd380Sjfb8856606 void
ionic_cq_map(struct ionic_cq * cq,void * base,rte_iova_t base_pa)385*2d9fd380Sjfb8856606 ionic_cq_map(struct ionic_cq *cq, void *base, rte_iova_t base_pa)
386*2d9fd380Sjfb8856606 {
387*2d9fd380Sjfb8856606 	cq->base = base;
388*2d9fd380Sjfb8856606 	cq->base_pa = base_pa;
389*2d9fd380Sjfb8856606 }
390*2d9fd380Sjfb8856606 
391*2d9fd380Sjfb8856606 void
ionic_cq_bind(struct ionic_cq * cq,struct ionic_queue * q)392*2d9fd380Sjfb8856606 ionic_cq_bind(struct ionic_cq *cq, struct ionic_queue *q)
393*2d9fd380Sjfb8856606 {
394*2d9fd380Sjfb8856606 	cq->bound_q = q;
395*2d9fd380Sjfb8856606 	q->bound_cq = cq;
396*2d9fd380Sjfb8856606 }
397*2d9fd380Sjfb8856606 
398*2d9fd380Sjfb8856606 uint32_t
ionic_cq_service(struct ionic_cq * cq,uint32_t work_to_do,ionic_cq_cb cb,void * cb_arg)399*2d9fd380Sjfb8856606 ionic_cq_service(struct ionic_cq *cq, uint32_t work_to_do,
400*2d9fd380Sjfb8856606 		 ionic_cq_cb cb, void *cb_arg)
401*2d9fd380Sjfb8856606 {
402*2d9fd380Sjfb8856606 	uint32_t work_done = 0;
403*2d9fd380Sjfb8856606 
404*2d9fd380Sjfb8856606 	if (work_to_do == 0)
405*2d9fd380Sjfb8856606 		return 0;
406*2d9fd380Sjfb8856606 
407*2d9fd380Sjfb8856606 	while (cb(cq, cq->tail_idx, cb_arg)) {
408*2d9fd380Sjfb8856606 		cq->tail_idx = (cq->tail_idx + 1) & (cq->num_descs - 1);
409*2d9fd380Sjfb8856606 		if (cq->tail_idx == 0)
410*2d9fd380Sjfb8856606 			cq->done_color = !cq->done_color;
411*2d9fd380Sjfb8856606 
412*2d9fd380Sjfb8856606 		if (++work_done == work_to_do)
413*2d9fd380Sjfb8856606 			break;
414*2d9fd380Sjfb8856606 	}
415*2d9fd380Sjfb8856606 
416*2d9fd380Sjfb8856606 	return work_done;
417*2d9fd380Sjfb8856606 }
418*2d9fd380Sjfb8856606 
419*2d9fd380Sjfb8856606 int
ionic_q_init(struct ionic_lif * lif,struct ionic_dev * idev,struct ionic_queue * q,uint32_t index,uint32_t num_descs,size_t desc_size,size_t sg_desc_size,uint32_t pid)420*2d9fd380Sjfb8856606 ionic_q_init(struct ionic_lif *lif, struct ionic_dev *idev,
421*2d9fd380Sjfb8856606 	     struct ionic_queue *q, uint32_t index, uint32_t num_descs,
422*2d9fd380Sjfb8856606 	     size_t desc_size, size_t sg_desc_size, uint32_t pid)
423*2d9fd380Sjfb8856606 {
424*2d9fd380Sjfb8856606 	uint32_t ring_size;
425*2d9fd380Sjfb8856606 
426*2d9fd380Sjfb8856606 	if (desc_size == 0 || !rte_is_power_of_2(num_descs))
427*2d9fd380Sjfb8856606 		return -EINVAL;
428*2d9fd380Sjfb8856606 
429*2d9fd380Sjfb8856606 	ring_size = rte_log2_u32(num_descs);
430*2d9fd380Sjfb8856606 
431*2d9fd380Sjfb8856606 	if (ring_size < 2 || ring_size > 16)
432*2d9fd380Sjfb8856606 		return -EINVAL;
433*2d9fd380Sjfb8856606 
434*2d9fd380Sjfb8856606 	q->lif = lif;
435*2d9fd380Sjfb8856606 	q->idev = idev;
436*2d9fd380Sjfb8856606 	q->index = index;
437*2d9fd380Sjfb8856606 	q->num_descs = num_descs;
438*2d9fd380Sjfb8856606 	q->desc_size = desc_size;
439*2d9fd380Sjfb8856606 	q->sg_desc_size = sg_desc_size;
440*2d9fd380Sjfb8856606 	q->head_idx = 0;
441*2d9fd380Sjfb8856606 	q->tail_idx = 0;
442*2d9fd380Sjfb8856606 	q->pid = pid;
443*2d9fd380Sjfb8856606 
444*2d9fd380Sjfb8856606 	return 0;
445*2d9fd380Sjfb8856606 }
446*2d9fd380Sjfb8856606 
447*2d9fd380Sjfb8856606 void
ionic_q_map(struct ionic_queue * q,void * base,rte_iova_t base_pa)448*2d9fd380Sjfb8856606 ionic_q_map(struct ionic_queue *q, void *base, rte_iova_t base_pa)
449*2d9fd380Sjfb8856606 {
450*2d9fd380Sjfb8856606 	q->base = base;
451*2d9fd380Sjfb8856606 	q->base_pa = base_pa;
452*2d9fd380Sjfb8856606 }
453*2d9fd380Sjfb8856606 
454*2d9fd380Sjfb8856606 void
ionic_q_sg_map(struct ionic_queue * q,void * base,rte_iova_t base_pa)455*2d9fd380Sjfb8856606 ionic_q_sg_map(struct ionic_queue *q, void *base, rte_iova_t base_pa)
456*2d9fd380Sjfb8856606 {
457*2d9fd380Sjfb8856606 	q->sg_base = base;
458*2d9fd380Sjfb8856606 	q->sg_base_pa = base_pa;
459*2d9fd380Sjfb8856606 }
460*2d9fd380Sjfb8856606 
461*2d9fd380Sjfb8856606 void
ionic_q_flush(struct ionic_queue * q)462*2d9fd380Sjfb8856606 ionic_q_flush(struct ionic_queue *q)
463*2d9fd380Sjfb8856606 {
464*2d9fd380Sjfb8856606 	writeq(IONIC_DBELL_QID(q->hw_index) | q->head_idx, q->db);
465*2d9fd380Sjfb8856606 }
466*2d9fd380Sjfb8856606 
467*2d9fd380Sjfb8856606 void
ionic_q_post(struct ionic_queue * q,bool ring_doorbell,desc_cb cb,void * cb_arg)468*2d9fd380Sjfb8856606 ionic_q_post(struct ionic_queue *q, bool ring_doorbell, desc_cb cb,
469*2d9fd380Sjfb8856606 	     void *cb_arg)
470*2d9fd380Sjfb8856606 {
471*2d9fd380Sjfb8856606 	struct ionic_desc_info *head = &q->info[q->head_idx];
472*2d9fd380Sjfb8856606 
473*2d9fd380Sjfb8856606 	head->cb = cb;
474*2d9fd380Sjfb8856606 	head->cb_arg = cb_arg;
475*2d9fd380Sjfb8856606 
476*2d9fd380Sjfb8856606 	q->head_idx = (q->head_idx + 1) & (q->num_descs - 1);
477*2d9fd380Sjfb8856606 
478*2d9fd380Sjfb8856606 	if (ring_doorbell)
479*2d9fd380Sjfb8856606 		ionic_q_flush(q);
480*2d9fd380Sjfb8856606 }
481*2d9fd380Sjfb8856606 
482*2d9fd380Sjfb8856606 uint32_t
ionic_q_space_avail(struct ionic_queue * q)483*2d9fd380Sjfb8856606 ionic_q_space_avail(struct ionic_queue *q)
484*2d9fd380Sjfb8856606 {
485*2d9fd380Sjfb8856606 	uint32_t avail = q->tail_idx;
486*2d9fd380Sjfb8856606 
487*2d9fd380Sjfb8856606 	if (q->head_idx >= avail)
488*2d9fd380Sjfb8856606 		avail += q->num_descs - q->head_idx - 1;
489*2d9fd380Sjfb8856606 	else
490*2d9fd380Sjfb8856606 		avail -= q->head_idx + 1;
491*2d9fd380Sjfb8856606 
492*2d9fd380Sjfb8856606 	return avail;
493*2d9fd380Sjfb8856606 }
494*2d9fd380Sjfb8856606 
495*2d9fd380Sjfb8856606 bool
ionic_q_has_space(struct ionic_queue * q,uint32_t want)496*2d9fd380Sjfb8856606 ionic_q_has_space(struct ionic_queue *q, uint32_t want)
497*2d9fd380Sjfb8856606 {
498*2d9fd380Sjfb8856606 	return ionic_q_space_avail(q) >= want;
499*2d9fd380Sjfb8856606 }
500*2d9fd380Sjfb8856606 
501*2d9fd380Sjfb8856606 void
ionic_q_service(struct ionic_queue * q,uint32_t cq_desc_index,uint32_t stop_index,void * service_cb_arg)502*2d9fd380Sjfb8856606 ionic_q_service(struct ionic_queue *q, uint32_t cq_desc_index,
503*2d9fd380Sjfb8856606 		uint32_t stop_index, void *service_cb_arg)
504*2d9fd380Sjfb8856606 {
505*2d9fd380Sjfb8856606 	struct ionic_desc_info *desc_info;
506*2d9fd380Sjfb8856606 	uint32_t curr_q_tail_idx;
507*2d9fd380Sjfb8856606 
508*2d9fd380Sjfb8856606 	do {
509*2d9fd380Sjfb8856606 		desc_info = &q->info[q->tail_idx];
510*2d9fd380Sjfb8856606 
511*2d9fd380Sjfb8856606 		if (desc_info->cb)
512*2d9fd380Sjfb8856606 			desc_info->cb(q, q->tail_idx, cq_desc_index,
513*2d9fd380Sjfb8856606 				desc_info->cb_arg, service_cb_arg);
514*2d9fd380Sjfb8856606 
515*2d9fd380Sjfb8856606 		desc_info->cb = NULL;
516*2d9fd380Sjfb8856606 		desc_info->cb_arg = NULL;
517*2d9fd380Sjfb8856606 
518*2d9fd380Sjfb8856606 		curr_q_tail_idx = q->tail_idx;
519*2d9fd380Sjfb8856606 		q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
520*2d9fd380Sjfb8856606 
521*2d9fd380Sjfb8856606 	} while (curr_q_tail_idx != stop_index);
522*2d9fd380Sjfb8856606 }
523*2d9fd380Sjfb8856606 
524*2d9fd380Sjfb8856606 static void
ionic_adminq_cb(struct ionic_queue * q,uint32_t q_desc_index,uint32_t cq_desc_index,void * cb_arg,void * service_cb_arg __rte_unused)525*2d9fd380Sjfb8856606 ionic_adminq_cb(struct ionic_queue *q,
526*2d9fd380Sjfb8856606 		uint32_t q_desc_index, uint32_t cq_desc_index,
527*2d9fd380Sjfb8856606 		void *cb_arg, void *service_cb_arg __rte_unused)
528*2d9fd380Sjfb8856606 {
529*2d9fd380Sjfb8856606 	struct ionic_admin_ctx *ctx = cb_arg;
530*2d9fd380Sjfb8856606 	struct ionic_admin_comp *cq_desc_base = q->bound_cq->base;
531*2d9fd380Sjfb8856606 	struct ionic_admin_comp *cq_desc = &cq_desc_base[cq_desc_index];
532*2d9fd380Sjfb8856606 
533*2d9fd380Sjfb8856606 	if (unlikely(cq_desc->comp_index != q_desc_index)) {
534*2d9fd380Sjfb8856606 		IONIC_WARN_ON(cq_desc->comp_index != q_desc_index);
535*2d9fd380Sjfb8856606 		return;
536*2d9fd380Sjfb8856606 	}
537*2d9fd380Sjfb8856606 
538*2d9fd380Sjfb8856606 	memcpy(&ctx->comp, cq_desc, sizeof(*cq_desc));
539*2d9fd380Sjfb8856606 
540*2d9fd380Sjfb8856606 	ctx->pending_work = false; /* done */
541*2d9fd380Sjfb8856606 }
542*2d9fd380Sjfb8856606 
543*2d9fd380Sjfb8856606 /** ionic_adminq_post - Post an admin command.
544*2d9fd380Sjfb8856606  * @lif:		Handle to lif.
545*2d9fd380Sjfb8856606  * @cmd_ctx:		Api admin command context.
546*2d9fd380Sjfb8856606  *
547*2d9fd380Sjfb8856606  * Post the command to an admin queue in the ethernet driver.  If this command
548*2d9fd380Sjfb8856606  * succeeds, then the command has been posted, but that does not indicate a
549*2d9fd380Sjfb8856606  * completion.  If this command returns success, then the completion callback
550*2d9fd380Sjfb8856606  * will eventually be called.
551*2d9fd380Sjfb8856606  *
552*2d9fd380Sjfb8856606  * Return: zero or negative error status.
553*2d9fd380Sjfb8856606  */
554*2d9fd380Sjfb8856606 int
ionic_adminq_post(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)555*2d9fd380Sjfb8856606 ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
556*2d9fd380Sjfb8856606 {
557*2d9fd380Sjfb8856606 	struct ionic_queue *adminq = &lif->adminqcq->q;
558*2d9fd380Sjfb8856606 	struct ionic_admin_cmd *q_desc_base = adminq->base;
559*2d9fd380Sjfb8856606 	struct ionic_admin_cmd *q_desc;
560*2d9fd380Sjfb8856606 	int err = 0;
561*2d9fd380Sjfb8856606 
562*2d9fd380Sjfb8856606 	rte_spinlock_lock(&lif->adminq_lock);
563*2d9fd380Sjfb8856606 
564*2d9fd380Sjfb8856606 	if (!ionic_q_has_space(adminq, 1)) {
565*2d9fd380Sjfb8856606 		err = -ENOSPC;
566*2d9fd380Sjfb8856606 		goto err_out;
567*2d9fd380Sjfb8856606 	}
568*2d9fd380Sjfb8856606 
569*2d9fd380Sjfb8856606 	q_desc = &q_desc_base[adminq->head_idx];
570*2d9fd380Sjfb8856606 
571*2d9fd380Sjfb8856606 	memcpy(q_desc, &ctx->cmd, sizeof(ctx->cmd));
572*2d9fd380Sjfb8856606 
573*2d9fd380Sjfb8856606 	ionic_q_post(adminq, true, ionic_adminq_cb, ctx);
574*2d9fd380Sjfb8856606 
575*2d9fd380Sjfb8856606 err_out:
576*2d9fd380Sjfb8856606 	rte_spinlock_unlock(&lif->adminq_lock);
577*2d9fd380Sjfb8856606 
578*2d9fd380Sjfb8856606 	return err;
579*2d9fd380Sjfb8856606 }
580