1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2017 - 2019 Pensando Systems, Inc */
3
4 #include <linux/printk.h>
5 #include <linux/dynamic_debug.h>
6 #include <linux/module.h>
7 #include <linux/netdevice.h>
8 #include <linux/utsname.h>
9 #include <generated/utsrelease.h>
10 #include <linux/ctype.h>
11
12 #include "ionic.h"
13 #include "ionic_bus.h"
14 #include "ionic_lif.h"
15 #include "ionic_debugfs.h"
16
17 MODULE_DESCRIPTION(IONIC_DRV_DESCRIPTION);
18 MODULE_AUTHOR("Pensando Systems, Inc");
19 MODULE_LICENSE("GPL");
20
ionic_error_to_str(enum ionic_status_code code)21 static const char *ionic_error_to_str(enum ionic_status_code code)
22 {
23 switch (code) {
24 case IONIC_RC_SUCCESS:
25 return "IONIC_RC_SUCCESS";
26 case IONIC_RC_EVERSION:
27 return "IONIC_RC_EVERSION";
28 case IONIC_RC_EOPCODE:
29 return "IONIC_RC_EOPCODE";
30 case IONIC_RC_EIO:
31 return "IONIC_RC_EIO";
32 case IONIC_RC_EPERM:
33 return "IONIC_RC_EPERM";
34 case IONIC_RC_EQID:
35 return "IONIC_RC_EQID";
36 case IONIC_RC_EQTYPE:
37 return "IONIC_RC_EQTYPE";
38 case IONIC_RC_ENOENT:
39 return "IONIC_RC_ENOENT";
40 case IONIC_RC_EINTR:
41 return "IONIC_RC_EINTR";
42 case IONIC_RC_EAGAIN:
43 return "IONIC_RC_EAGAIN";
44 case IONIC_RC_ENOMEM:
45 return "IONIC_RC_ENOMEM";
46 case IONIC_RC_EFAULT:
47 return "IONIC_RC_EFAULT";
48 case IONIC_RC_EBUSY:
49 return "IONIC_RC_EBUSY";
50 case IONIC_RC_EEXIST:
51 return "IONIC_RC_EEXIST";
52 case IONIC_RC_EINVAL:
53 return "IONIC_RC_EINVAL";
54 case IONIC_RC_ENOSPC:
55 return "IONIC_RC_ENOSPC";
56 case IONIC_RC_ERANGE:
57 return "IONIC_RC_ERANGE";
58 case IONIC_RC_BAD_ADDR:
59 return "IONIC_RC_BAD_ADDR";
60 case IONIC_RC_DEV_CMD:
61 return "IONIC_RC_DEV_CMD";
62 case IONIC_RC_ENOSUPP:
63 return "IONIC_RC_ENOSUPP";
64 case IONIC_RC_ERROR:
65 return "IONIC_RC_ERROR";
66 case IONIC_RC_ERDMA:
67 return "IONIC_RC_ERDMA";
68 case IONIC_RC_EBAD_FW:
69 return "IONIC_RC_EBAD_FW";
70 default:
71 return "IONIC_RC_UNKNOWN";
72 }
73 }
74
ionic_error_to_errno(enum ionic_status_code code)75 static int ionic_error_to_errno(enum ionic_status_code code)
76 {
77 switch (code) {
78 case IONIC_RC_SUCCESS:
79 return 0;
80 case IONIC_RC_EVERSION:
81 case IONIC_RC_EQTYPE:
82 case IONIC_RC_EQID:
83 case IONIC_RC_EINVAL:
84 case IONIC_RC_ENOSUPP:
85 return -EINVAL;
86 case IONIC_RC_EPERM:
87 return -EPERM;
88 case IONIC_RC_ENOENT:
89 return -ENOENT;
90 case IONIC_RC_EAGAIN:
91 return -EAGAIN;
92 case IONIC_RC_ENOMEM:
93 return -ENOMEM;
94 case IONIC_RC_EFAULT:
95 return -EFAULT;
96 case IONIC_RC_EBUSY:
97 return -EBUSY;
98 case IONIC_RC_EEXIST:
99 return -EEXIST;
100 case IONIC_RC_ENOSPC:
101 return -ENOSPC;
102 case IONIC_RC_ERANGE:
103 return -ERANGE;
104 case IONIC_RC_BAD_ADDR:
105 return -EFAULT;
106 case IONIC_RC_EOPCODE:
107 case IONIC_RC_EINTR:
108 case IONIC_RC_DEV_CMD:
109 case IONIC_RC_ERROR:
110 case IONIC_RC_ERDMA:
111 case IONIC_RC_EIO:
112 default:
113 return -EIO;
114 }
115 }
116
ionic_opcode_to_str(enum ionic_cmd_opcode opcode)117 static const char *ionic_opcode_to_str(enum ionic_cmd_opcode opcode)
118 {
119 switch (opcode) {
120 case IONIC_CMD_NOP:
121 return "IONIC_CMD_NOP";
122 case IONIC_CMD_INIT:
123 return "IONIC_CMD_INIT";
124 case IONIC_CMD_RESET:
125 return "IONIC_CMD_RESET";
126 case IONIC_CMD_IDENTIFY:
127 return "IONIC_CMD_IDENTIFY";
128 case IONIC_CMD_GETATTR:
129 return "IONIC_CMD_GETATTR";
130 case IONIC_CMD_SETATTR:
131 return "IONIC_CMD_SETATTR";
132 case IONIC_CMD_PORT_IDENTIFY:
133 return "IONIC_CMD_PORT_IDENTIFY";
134 case IONIC_CMD_PORT_INIT:
135 return "IONIC_CMD_PORT_INIT";
136 case IONIC_CMD_PORT_RESET:
137 return "IONIC_CMD_PORT_RESET";
138 case IONIC_CMD_PORT_GETATTR:
139 return "IONIC_CMD_PORT_GETATTR";
140 case IONIC_CMD_PORT_SETATTR:
141 return "IONIC_CMD_PORT_SETATTR";
142 case IONIC_CMD_LIF_INIT:
143 return "IONIC_CMD_LIF_INIT";
144 case IONIC_CMD_LIF_RESET:
145 return "IONIC_CMD_LIF_RESET";
146 case IONIC_CMD_LIF_IDENTIFY:
147 return "IONIC_CMD_LIF_IDENTIFY";
148 case IONIC_CMD_LIF_SETATTR:
149 return "IONIC_CMD_LIF_SETATTR";
150 case IONIC_CMD_LIF_GETATTR:
151 return "IONIC_CMD_LIF_GETATTR";
152 case IONIC_CMD_LIF_SETPHC:
153 return "IONIC_CMD_LIF_SETPHC";
154 case IONIC_CMD_RX_MODE_SET:
155 return "IONIC_CMD_RX_MODE_SET";
156 case IONIC_CMD_RX_FILTER_ADD:
157 return "IONIC_CMD_RX_FILTER_ADD";
158 case IONIC_CMD_RX_FILTER_DEL:
159 return "IONIC_CMD_RX_FILTER_DEL";
160 case IONIC_CMD_Q_IDENTIFY:
161 return "IONIC_CMD_Q_IDENTIFY";
162 case IONIC_CMD_Q_INIT:
163 return "IONIC_CMD_Q_INIT";
164 case IONIC_CMD_Q_CONTROL:
165 return "IONIC_CMD_Q_CONTROL";
166 case IONIC_CMD_RDMA_RESET_LIF:
167 return "IONIC_CMD_RDMA_RESET_LIF";
168 case IONIC_CMD_RDMA_CREATE_EQ:
169 return "IONIC_CMD_RDMA_CREATE_EQ";
170 case IONIC_CMD_RDMA_CREATE_CQ:
171 return "IONIC_CMD_RDMA_CREATE_CQ";
172 case IONIC_CMD_RDMA_CREATE_ADMINQ:
173 return "IONIC_CMD_RDMA_CREATE_ADMINQ";
174 case IONIC_CMD_FW_DOWNLOAD:
175 return "IONIC_CMD_FW_DOWNLOAD";
176 case IONIC_CMD_FW_CONTROL:
177 return "IONIC_CMD_FW_CONTROL";
178 case IONIC_CMD_FW_DOWNLOAD_V1:
179 return "IONIC_CMD_FW_DOWNLOAD_V1";
180 case IONIC_CMD_FW_CONTROL_V1:
181 return "IONIC_CMD_FW_CONTROL_V1";
182 case IONIC_CMD_VF_GETATTR:
183 return "IONIC_CMD_VF_GETATTR";
184 case IONIC_CMD_VF_SETATTR:
185 return "IONIC_CMD_VF_SETATTR";
186 default:
187 return "DEVCMD_UNKNOWN";
188 }
189 }
190
ionic_vf_attr_to_str(enum ionic_vf_attr attr)191 const char *ionic_vf_attr_to_str(enum ionic_vf_attr attr)
192 {
193 switch (attr) {
194 case IONIC_VF_ATTR_SPOOFCHK:
195 return "IONIC_VF_ATTR_SPOOFCHK";
196 case IONIC_VF_ATTR_TRUST:
197 return "IONIC_VF_ATTR_TRUST";
198 case IONIC_VF_ATTR_LINKSTATE:
199 return "IONIC_VF_ATTR_LINKSTATE";
200 case IONIC_VF_ATTR_MAC:
201 return "IONIC_VF_ATTR_MAC";
202 case IONIC_VF_ATTR_VLAN:
203 return "IONIC_VF_ATTR_VLAN";
204 case IONIC_VF_ATTR_RATE:
205 return "IONIC_VF_ATTR_RATE";
206 case IONIC_VF_ATTR_STATSADDR:
207 return "IONIC_VF_ATTR_STATSADDR";
208 default:
209 return "IONIC_VF_ATTR_UNKNOWN";
210 }
211 }
212
ionic_adminq_flush(struct ionic_lif * lif)213 static void ionic_adminq_flush(struct ionic_lif *lif)
214 {
215 struct ionic_desc_info *desc_info;
216 unsigned long irqflags;
217 struct ionic_queue *q;
218
219 spin_lock_irqsave(&lif->adminq_lock, irqflags);
220 if (!lif->adminqcq) {
221 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
222 return;
223 }
224
225 q = &lif->adminqcq->q;
226
227 while (q->tail_idx != q->head_idx) {
228 desc_info = &q->info[q->tail_idx];
229 memset(desc_info->desc, 0, sizeof(union ionic_adminq_cmd));
230 desc_info->cb = NULL;
231 desc_info->cb_arg = NULL;
232 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
233 }
234 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
235 }
236
ionic_adminq_netdev_err_print(struct ionic_lif * lif,u8 opcode,u8 status,int err)237 void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode,
238 u8 status, int err)
239 {
240 const char *stat_str;
241
242 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
243 ionic_error_to_str(status);
244
245 netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n",
246 ionic_opcode_to_str(opcode), opcode, stat_str, err);
247 }
248
ionic_adminq_check_err(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const bool timeout,const bool do_msg)249 static int ionic_adminq_check_err(struct ionic_lif *lif,
250 struct ionic_admin_ctx *ctx,
251 const bool timeout,
252 const bool do_msg)
253 {
254 int err = 0;
255
256 if (ctx->comp.comp.status || timeout) {
257 err = timeout ? -ETIMEDOUT :
258 ionic_error_to_errno(ctx->comp.comp.status);
259
260 if (do_msg)
261 ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode,
262 ctx->comp.comp.status, err);
263
264 if (timeout)
265 ionic_adminq_flush(lif);
266 }
267
268 return err;
269 }
270
ionic_adminq_cb(struct ionic_queue * q,struct ionic_desc_info * desc_info,struct ionic_cq_info * cq_info,void * cb_arg)271 static void ionic_adminq_cb(struct ionic_queue *q,
272 struct ionic_desc_info *desc_info,
273 struct ionic_cq_info *cq_info, void *cb_arg)
274 {
275 struct ionic_admin_ctx *ctx = cb_arg;
276 struct ionic_admin_comp *comp;
277
278 if (!ctx)
279 return;
280
281 comp = cq_info->cq_desc;
282
283 memcpy(&ctx->comp, comp, sizeof(*comp));
284
285 dev_dbg(q->dev, "comp admin queue command:\n");
286 dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1,
287 &ctx->comp, sizeof(ctx->comp), true);
288
289 complete_all(&ctx->work);
290 }
291
ionic_adminq_poke_doorbell(struct ionic_queue * q)292 bool ionic_adminq_poke_doorbell(struct ionic_queue *q)
293 {
294 struct ionic_lif *lif = q->lif;
295 unsigned long now, then, dif;
296 unsigned long irqflags;
297
298 spin_lock_irqsave(&lif->adminq_lock, irqflags);
299
300 if (q->tail_idx == q->head_idx) {
301 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
302 return false;
303 }
304
305 now = READ_ONCE(jiffies);
306 then = q->dbell_jiffies;
307 dif = now - then;
308
309 if (dif > q->dbell_deadline) {
310 ionic_dbell_ring(q->lif->kern_dbpage, q->hw_type,
311 q->dbval | q->head_idx);
312
313 q->dbell_jiffies = now;
314 }
315
316 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
317
318 return true;
319 }
320
ionic_adminq_post(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)321 int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
322 {
323 struct ionic_desc_info *desc_info;
324 unsigned long irqflags;
325 struct ionic_queue *q;
326 int err = 0;
327
328 spin_lock_irqsave(&lif->adminq_lock, irqflags);
329 if (!lif->adminqcq) {
330 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
331 return -EIO;
332 }
333
334 q = &lif->adminqcq->q;
335
336 if (!ionic_q_has_space(q, 1)) {
337 err = -ENOSPC;
338 goto err_out;
339 }
340
341 err = ionic_heartbeat_check(lif->ionic);
342 if (err)
343 goto err_out;
344
345 desc_info = &q->info[q->head_idx];
346 memcpy(desc_info->desc, &ctx->cmd, sizeof(ctx->cmd));
347
348 dev_dbg(&lif->netdev->dev, "post admin queue command:\n");
349 dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1,
350 &ctx->cmd, sizeof(ctx->cmd), true);
351
352 ionic_q_post(q, true, ionic_adminq_cb, ctx);
353
354 err_out:
355 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
356
357 return err;
358 }
359
ionic_adminq_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const int err,const bool do_msg)360 int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx,
361 const int err, const bool do_msg)
362 {
363 struct net_device *netdev = lif->netdev;
364 unsigned long time_limit;
365 unsigned long time_start;
366 unsigned long time_done;
367 unsigned long remaining;
368 const char *name;
369
370 name = ionic_opcode_to_str(ctx->cmd.cmd.opcode);
371
372 if (err) {
373 if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state))
374 netdev_err(netdev, "Posting of %s (%d) failed: %d\n",
375 name, ctx->cmd.cmd.opcode, err);
376 ctx->comp.comp.status = IONIC_RC_ERROR;
377 return err;
378 }
379
380 time_start = jiffies;
381 time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT;
382 do {
383 remaining = wait_for_completion_timeout(&ctx->work,
384 IONIC_ADMINQ_TIME_SLICE);
385
386 /* check for done */
387 if (remaining)
388 break;
389
390 /* force a check of FW status and break out if FW reset */
391 ionic_heartbeat_check(lif->ionic);
392 if ((test_bit(IONIC_LIF_F_FW_RESET, lif->state) &&
393 !lif->ionic->idev.fw_status_ready) ||
394 test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) {
395 if (do_msg)
396 netdev_warn(netdev, "%s (%d) interrupted, FW in reset\n",
397 name, ctx->cmd.cmd.opcode);
398 ctx->comp.comp.status = IONIC_RC_ERROR;
399 return -ENXIO;
400 }
401
402 } while (time_before(jiffies, time_limit));
403 time_done = jiffies;
404
405 dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n",
406 __func__, jiffies_to_msecs(time_done - time_start));
407
408 return ionic_adminq_check_err(lif, ctx,
409 time_after_eq(time_done, time_limit),
410 do_msg);
411 }
412
ionic_adminq_post_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)413 int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
414 {
415 int err;
416
417 err = ionic_adminq_post(lif, ctx);
418
419 return ionic_adminq_wait(lif, ctx, err, true);
420 }
421
ionic_adminq_post_wait_nomsg(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)422 int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
423 {
424 int err;
425
426 err = ionic_adminq_post(lif, ctx);
427
428 return ionic_adminq_wait(lif, ctx, err, false);
429 }
430
ionic_dev_cmd_clean(struct ionic * ionic)431 static void ionic_dev_cmd_clean(struct ionic *ionic)
432 {
433 struct ionic_dev *idev = &ionic->idev;
434
435 iowrite32(0, &idev->dev_cmd_regs->doorbell);
436 memset_io(&idev->dev_cmd_regs->cmd, 0, sizeof(idev->dev_cmd_regs->cmd));
437 }
438
ionic_dev_cmd_dev_err_print(struct ionic * ionic,u8 opcode,u8 status,int err)439 void ionic_dev_cmd_dev_err_print(struct ionic *ionic, u8 opcode, u8 status,
440 int err)
441 {
442 const char *stat_str;
443
444 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
445 ionic_error_to_str(status);
446
447 dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n",
448 ionic_opcode_to_str(opcode), opcode, stat_str, err);
449 }
450
__ionic_dev_cmd_wait(struct ionic * ionic,unsigned long max_seconds,const bool do_msg)451 static int __ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds,
452 const bool do_msg)
453 {
454 struct ionic_dev *idev = &ionic->idev;
455 unsigned long start_time;
456 unsigned long max_wait;
457 unsigned long duration;
458 int done = 0;
459 bool fw_up;
460 int opcode;
461 int err;
462
463 /* Wait for dev cmd to complete, retrying if we get EAGAIN,
464 * but don't wait any longer than max_seconds.
465 */
466 max_wait = jiffies + (max_seconds * HZ);
467 try_again:
468 opcode = readb(&idev->dev_cmd_regs->cmd.cmd.opcode);
469 start_time = jiffies;
470 for (fw_up = ionic_is_fw_running(idev);
471 !done && fw_up && time_before(jiffies, max_wait);
472 fw_up = ionic_is_fw_running(idev)) {
473 done = ionic_dev_cmd_done(idev);
474 if (done)
475 break;
476 usleep_range(100, 200);
477 }
478 duration = jiffies - start_time;
479
480 dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n",
481 ionic_opcode_to_str(opcode), opcode,
482 done, duration / HZ, duration);
483
484 if (!done && !fw_up) {
485 ionic_dev_cmd_clean(ionic);
486 dev_warn(ionic->dev, "DEVCMD %s (%d) interrupted - FW is down\n",
487 ionic_opcode_to_str(opcode), opcode);
488 return -ENXIO;
489 }
490
491 if (!done && !time_before(jiffies, max_wait)) {
492 ionic_dev_cmd_clean(ionic);
493 dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n",
494 ionic_opcode_to_str(opcode), opcode, max_seconds);
495 return -ETIMEDOUT;
496 }
497
498 err = ionic_dev_cmd_status(&ionic->idev);
499 if (err) {
500 if (err == IONIC_RC_EAGAIN &&
501 time_before(jiffies, (max_wait - HZ))) {
502 dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n",
503 ionic_opcode_to_str(opcode), opcode,
504 ionic_error_to_str(err), err);
505
506 iowrite32(0, &idev->dev_cmd_regs->done);
507 msleep(1000);
508 iowrite32(1, &idev->dev_cmd_regs->doorbell);
509 goto try_again;
510 }
511
512 if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN))
513 if (do_msg)
514 ionic_dev_cmd_dev_err_print(ionic, opcode, err,
515 ionic_error_to_errno(err));
516
517 return ionic_error_to_errno(err);
518 }
519
520 ionic_dev_cmd_clean(ionic);
521
522 return 0;
523 }
524
ionic_dev_cmd_wait(struct ionic * ionic,unsigned long max_seconds)525 int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds)
526 {
527 return __ionic_dev_cmd_wait(ionic, max_seconds, true);
528 }
529
ionic_dev_cmd_wait_nomsg(struct ionic * ionic,unsigned long max_seconds)530 int ionic_dev_cmd_wait_nomsg(struct ionic *ionic, unsigned long max_seconds)
531 {
532 return __ionic_dev_cmd_wait(ionic, max_seconds, false);
533 }
534
ionic_setup(struct ionic * ionic)535 int ionic_setup(struct ionic *ionic)
536 {
537 int err;
538
539 err = ionic_dev_setup(ionic);
540 if (err)
541 return err;
542 ionic_reset(ionic);
543
544 return 0;
545 }
546
ionic_identify(struct ionic * ionic)547 int ionic_identify(struct ionic *ionic)
548 {
549 struct ionic_identity *ident = &ionic->ident;
550 struct ionic_dev *idev = &ionic->idev;
551 size_t sz;
552 int err;
553
554 memset(ident, 0, sizeof(*ident));
555
556 ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX);
557 strncpy(ident->drv.driver_ver_str, UTS_RELEASE,
558 sizeof(ident->drv.driver_ver_str) - 1);
559
560 mutex_lock(&ionic->dev_cmd_lock);
561
562 sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data));
563 memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz);
564
565 ionic_dev_cmd_identify(idev, IONIC_DEV_IDENTITY_VERSION_2);
566 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
567 if (!err) {
568 sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data));
569 memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz);
570 }
571 mutex_unlock(&ionic->dev_cmd_lock);
572
573 if (err) {
574 dev_err(ionic->dev, "Cannot identify ionic: %d\n", err);
575 goto err_out;
576 }
577
578 if (isprint(idev->dev_info.fw_version[0]) &&
579 isascii(idev->dev_info.fw_version[0]))
580 dev_info(ionic->dev, "FW: %.*s\n",
581 (int)(sizeof(idev->dev_info.fw_version) - 1),
582 idev->dev_info.fw_version);
583 else
584 dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n",
585 (u8)idev->dev_info.fw_version[0],
586 (u8)idev->dev_info.fw_version[1],
587 (u8)idev->dev_info.fw_version[2],
588 (u8)idev->dev_info.fw_version[3]);
589
590 err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC,
591 &ionic->ident.lif);
592 if (err) {
593 dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err);
594 goto err_out;
595 }
596
597 return 0;
598
599 err_out:
600 return err;
601 }
602
ionic_init(struct ionic * ionic)603 int ionic_init(struct ionic *ionic)
604 {
605 struct ionic_dev *idev = &ionic->idev;
606 int err;
607
608 mutex_lock(&ionic->dev_cmd_lock);
609 ionic_dev_cmd_init(idev);
610 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
611 mutex_unlock(&ionic->dev_cmd_lock);
612
613 return err;
614 }
615
ionic_reset(struct ionic * ionic)616 int ionic_reset(struct ionic *ionic)
617 {
618 struct ionic_dev *idev = &ionic->idev;
619 int err;
620
621 if (!ionic_is_fw_running(idev))
622 return 0;
623
624 mutex_lock(&ionic->dev_cmd_lock);
625 ionic_dev_cmd_reset(idev);
626 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
627 mutex_unlock(&ionic->dev_cmd_lock);
628
629 return err;
630 }
631
ionic_port_identify(struct ionic * ionic)632 int ionic_port_identify(struct ionic *ionic)
633 {
634 struct ionic_identity *ident = &ionic->ident;
635 struct ionic_dev *idev = &ionic->idev;
636 size_t sz;
637 int err;
638
639 mutex_lock(&ionic->dev_cmd_lock);
640
641 ionic_dev_cmd_port_identify(idev);
642 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
643 if (!err) {
644 sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data));
645 memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz);
646 }
647
648 mutex_unlock(&ionic->dev_cmd_lock);
649
650 return err;
651 }
652
ionic_port_init(struct ionic * ionic)653 int ionic_port_init(struct ionic *ionic)
654 {
655 struct ionic_identity *ident = &ionic->ident;
656 struct ionic_dev *idev = &ionic->idev;
657 size_t sz;
658 int err;
659
660 if (!idev->port_info) {
661 idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE);
662 idev->port_info = dma_alloc_coherent(ionic->dev,
663 idev->port_info_sz,
664 &idev->port_info_pa,
665 GFP_KERNEL);
666 if (!idev->port_info)
667 return -ENOMEM;
668 }
669
670 sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data));
671
672 mutex_lock(&ionic->dev_cmd_lock);
673
674 memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz);
675 ionic_dev_cmd_port_init(idev);
676 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
677
678 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP);
679 ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
680
681 mutex_unlock(&ionic->dev_cmd_lock);
682 if (err) {
683 dev_err(ionic->dev, "Failed to init port\n");
684 dma_free_coherent(ionic->dev, idev->port_info_sz,
685 idev->port_info, idev->port_info_pa);
686 idev->port_info = NULL;
687 idev->port_info_pa = 0;
688 }
689
690 return err;
691 }
692
ionic_port_reset(struct ionic * ionic)693 int ionic_port_reset(struct ionic *ionic)
694 {
695 struct ionic_dev *idev = &ionic->idev;
696 int err = 0;
697
698 if (!idev->port_info)
699 return 0;
700
701 if (ionic_is_fw_running(idev)) {
702 mutex_lock(&ionic->dev_cmd_lock);
703 ionic_dev_cmd_port_reset(idev);
704 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
705 mutex_unlock(&ionic->dev_cmd_lock);
706 }
707
708 dma_free_coherent(ionic->dev, idev->port_info_sz,
709 idev->port_info, idev->port_info_pa);
710
711 idev->port_info = NULL;
712 idev->port_info_pa = 0;
713
714 return err;
715 }
716
ionic_init_module(void)717 static int __init ionic_init_module(void)
718 {
719 int ret;
720
721 ionic_debugfs_create();
722 ret = ionic_bus_register_driver();
723 if (ret)
724 ionic_debugfs_destroy();
725
726 return ret;
727 }
728
ionic_cleanup_module(void)729 static void __exit ionic_cleanup_module(void)
730 {
731 ionic_bus_unregister_driver();
732 ionic_debugfs_destroy();
733
734 pr_info("%s removed\n", IONIC_DRV_NAME);
735 }
736
737 module_init(ionic_init_module);
738 module_exit(ionic_cleanup_module);
739