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_adminq_flush(struct ionic_lif * lif)191 static void ionic_adminq_flush(struct ionic_lif *lif)
192 {
193 struct ionic_desc_info *desc_info;
194 unsigned long irqflags;
195 struct ionic_queue *q;
196
197 spin_lock_irqsave(&lif->adminq_lock, irqflags);
198 if (!lif->adminqcq) {
199 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
200 return;
201 }
202
203 q = &lif->adminqcq->q;
204
205 while (q->tail_idx != q->head_idx) {
206 desc_info = &q->info[q->tail_idx];
207 memset(desc_info->desc, 0, sizeof(union ionic_adminq_cmd));
208 desc_info->cb = NULL;
209 desc_info->cb_arg = NULL;
210 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
211 }
212 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
213 }
214
ionic_adminq_netdev_err_print(struct ionic_lif * lif,u8 opcode,u8 status,int err)215 void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode,
216 u8 status, int err)
217 {
218 const char *stat_str;
219
220 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
221 ionic_error_to_str(status);
222
223 netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n",
224 ionic_opcode_to_str(opcode), opcode, stat_str, err);
225 }
226
ionic_adminq_check_err(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const bool timeout,const bool do_msg)227 static int ionic_adminq_check_err(struct ionic_lif *lif,
228 struct ionic_admin_ctx *ctx,
229 const bool timeout,
230 const bool do_msg)
231 {
232 int err = 0;
233
234 if (ctx->comp.comp.status || timeout) {
235 err = timeout ? -ETIMEDOUT :
236 ionic_error_to_errno(ctx->comp.comp.status);
237
238 if (do_msg)
239 ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode,
240 ctx->comp.comp.status, err);
241
242 if (timeout)
243 ionic_adminq_flush(lif);
244 }
245
246 return err;
247 }
248
ionic_adminq_cb(struct ionic_queue * q,struct ionic_desc_info * desc_info,struct ionic_cq_info * cq_info,void * cb_arg)249 static void ionic_adminq_cb(struct ionic_queue *q,
250 struct ionic_desc_info *desc_info,
251 struct ionic_cq_info *cq_info, void *cb_arg)
252 {
253 struct ionic_admin_ctx *ctx = cb_arg;
254 struct ionic_admin_comp *comp;
255
256 if (!ctx)
257 return;
258
259 comp = cq_info->cq_desc;
260
261 memcpy(&ctx->comp, comp, sizeof(*comp));
262
263 dev_dbg(q->dev, "comp admin queue command:\n");
264 dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1,
265 &ctx->comp, sizeof(ctx->comp), true);
266
267 complete_all(&ctx->work);
268 }
269
ionic_adminq_poke_doorbell(struct ionic_queue * q)270 bool ionic_adminq_poke_doorbell(struct ionic_queue *q)
271 {
272 struct ionic_lif *lif = q->lif;
273 unsigned long now, then, dif;
274 unsigned long irqflags;
275
276 spin_lock_irqsave(&lif->adminq_lock, irqflags);
277
278 if (q->tail_idx == q->head_idx) {
279 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
280 return false;
281 }
282
283 now = READ_ONCE(jiffies);
284 then = q->dbell_jiffies;
285 dif = now - then;
286
287 if (dif > q->dbell_deadline) {
288 ionic_dbell_ring(q->lif->kern_dbpage, q->hw_type,
289 q->dbval | q->head_idx);
290
291 q->dbell_jiffies = now;
292 }
293
294 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
295
296 return true;
297 }
298
ionic_adminq_post(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)299 int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
300 {
301 struct ionic_desc_info *desc_info;
302 unsigned long irqflags;
303 struct ionic_queue *q;
304 int err = 0;
305
306 spin_lock_irqsave(&lif->adminq_lock, irqflags);
307 if (!lif->adminqcq) {
308 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
309 return -EIO;
310 }
311
312 q = &lif->adminqcq->q;
313
314 if (!ionic_q_has_space(q, 1)) {
315 err = -ENOSPC;
316 goto err_out;
317 }
318
319 err = ionic_heartbeat_check(lif->ionic);
320 if (err)
321 goto err_out;
322
323 desc_info = &q->info[q->head_idx];
324 memcpy(desc_info->desc, &ctx->cmd, sizeof(ctx->cmd));
325
326 dev_dbg(&lif->netdev->dev, "post admin queue command:\n");
327 dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1,
328 &ctx->cmd, sizeof(ctx->cmd), true);
329
330 ionic_q_post(q, true, ionic_adminq_cb, ctx);
331
332 err_out:
333 spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
334
335 return err;
336 }
337
ionic_adminq_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const int err,const bool do_msg)338 int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx,
339 const int err, const bool do_msg)
340 {
341 struct net_device *netdev = lif->netdev;
342 unsigned long time_limit;
343 unsigned long time_start;
344 unsigned long time_done;
345 unsigned long remaining;
346 const char *name;
347
348 name = ionic_opcode_to_str(ctx->cmd.cmd.opcode);
349
350 if (err) {
351 if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state))
352 netdev_err(netdev, "Posting of %s (%d) failed: %d\n",
353 name, ctx->cmd.cmd.opcode, err);
354 ctx->comp.comp.status = IONIC_RC_ERROR;
355 return err;
356 }
357
358 time_start = jiffies;
359 time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT;
360 do {
361 remaining = wait_for_completion_timeout(&ctx->work,
362 IONIC_ADMINQ_TIME_SLICE);
363
364 /* check for done */
365 if (remaining)
366 break;
367
368 /* force a check of FW status and break out if FW reset */
369 ionic_heartbeat_check(lif->ionic);
370 if ((test_bit(IONIC_LIF_F_FW_RESET, lif->state) &&
371 !lif->ionic->idev.fw_status_ready) ||
372 test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) {
373 if (do_msg)
374 netdev_warn(netdev, "%s (%d) interrupted, FW in reset\n",
375 name, ctx->cmd.cmd.opcode);
376 ctx->comp.comp.status = IONIC_RC_ERROR;
377 return -ENXIO;
378 }
379
380 } while (time_before(jiffies, time_limit));
381 time_done = jiffies;
382
383 dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n",
384 __func__, jiffies_to_msecs(time_done - time_start));
385
386 return ionic_adminq_check_err(lif, ctx,
387 time_after_eq(time_done, time_limit),
388 do_msg);
389 }
390
__ionic_adminq_post_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const bool do_msg)391 static int __ionic_adminq_post_wait(struct ionic_lif *lif,
392 struct ionic_admin_ctx *ctx,
393 const bool do_msg)
394 {
395 int err;
396
397 if (!ionic_is_fw_running(&lif->ionic->idev))
398 return 0;
399
400 err = ionic_adminq_post(lif, ctx);
401
402 return ionic_adminq_wait(lif, ctx, err, do_msg);
403 }
404
ionic_adminq_post_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)405 int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
406 {
407 return __ionic_adminq_post_wait(lif, ctx, true);
408 }
409
ionic_adminq_post_wait_nomsg(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)410 int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
411 {
412 return __ionic_adminq_post_wait(lif, ctx, false);
413 }
414
ionic_dev_cmd_clean(struct ionic * ionic)415 static void ionic_dev_cmd_clean(struct ionic *ionic)
416 {
417 struct ionic_dev *idev = &ionic->idev;
418
419 if (!idev->dev_cmd_regs)
420 return;
421
422 iowrite32(0, &idev->dev_cmd_regs->doorbell);
423 memset_io(&idev->dev_cmd_regs->cmd, 0, sizeof(idev->dev_cmd_regs->cmd));
424 }
425
ionic_dev_cmd_dev_err_print(struct ionic * ionic,u8 opcode,u8 status,int err)426 void ionic_dev_cmd_dev_err_print(struct ionic *ionic, u8 opcode, u8 status,
427 int err)
428 {
429 const char *stat_str;
430
431 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
432 ionic_error_to_str(status);
433
434 dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n",
435 ionic_opcode_to_str(opcode), opcode, stat_str, err);
436 }
437
__ionic_dev_cmd_wait(struct ionic * ionic,unsigned long max_seconds,const bool do_msg)438 static int __ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds,
439 const bool do_msg)
440 {
441 struct ionic_dev *idev = &ionic->idev;
442 unsigned long start_time;
443 unsigned long max_wait;
444 unsigned long duration;
445 int done = 0;
446 bool fw_up;
447 int opcode;
448 int err;
449
450 /* Wait for dev cmd to complete, retrying if we get EAGAIN,
451 * but don't wait any longer than max_seconds.
452 */
453 max_wait = jiffies + (max_seconds * HZ);
454 try_again:
455 opcode = idev->opcode;
456 start_time = jiffies;
457 for (fw_up = ionic_is_fw_running(idev);
458 !done && fw_up && time_before(jiffies, max_wait);
459 fw_up = ionic_is_fw_running(idev)) {
460 done = ionic_dev_cmd_done(idev);
461 if (done)
462 break;
463 usleep_range(100, 200);
464 }
465 duration = jiffies - start_time;
466
467 dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n",
468 ionic_opcode_to_str(opcode), opcode,
469 done, duration / HZ, duration);
470
471 if (!done && !fw_up) {
472 ionic_dev_cmd_clean(ionic);
473 dev_warn(ionic->dev, "DEVCMD %s (%d) interrupted - FW is down\n",
474 ionic_opcode_to_str(opcode), opcode);
475 return -ENXIO;
476 }
477
478 if (!done && !time_before(jiffies, max_wait)) {
479 ionic_dev_cmd_clean(ionic);
480 dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n",
481 ionic_opcode_to_str(opcode), opcode, max_seconds);
482 return -ETIMEDOUT;
483 }
484
485 err = ionic_dev_cmd_status(&ionic->idev);
486 if (err) {
487 if (err == IONIC_RC_EAGAIN &&
488 time_before(jiffies, (max_wait - HZ))) {
489 dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n",
490 ionic_opcode_to_str(opcode), opcode,
491 ionic_error_to_str(err), err);
492
493 iowrite32(0, &idev->dev_cmd_regs->done);
494 msleep(1000);
495 iowrite32(1, &idev->dev_cmd_regs->doorbell);
496 goto try_again;
497 }
498
499 if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN))
500 if (do_msg)
501 ionic_dev_cmd_dev_err_print(ionic, opcode, err,
502 ionic_error_to_errno(err));
503
504 return ionic_error_to_errno(err);
505 }
506
507 ionic_dev_cmd_clean(ionic);
508
509 return 0;
510 }
511
ionic_dev_cmd_wait(struct ionic * ionic,unsigned long max_seconds)512 int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds)
513 {
514 return __ionic_dev_cmd_wait(ionic, max_seconds, true);
515 }
516
ionic_dev_cmd_wait_nomsg(struct ionic * ionic,unsigned long max_seconds)517 int ionic_dev_cmd_wait_nomsg(struct ionic *ionic, unsigned long max_seconds)
518 {
519 return __ionic_dev_cmd_wait(ionic, max_seconds, false);
520 }
521
ionic_setup(struct ionic * ionic)522 int ionic_setup(struct ionic *ionic)
523 {
524 int err;
525
526 err = ionic_dev_setup(ionic);
527 if (err)
528 return err;
529 ionic_reset(ionic);
530
531 return 0;
532 }
533
ionic_identify(struct ionic * ionic)534 int ionic_identify(struct ionic *ionic)
535 {
536 struct ionic_identity *ident = &ionic->ident;
537 struct ionic_dev *idev = &ionic->idev;
538 size_t sz;
539 int err;
540
541 memset(ident, 0, sizeof(*ident));
542
543 ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX);
544 strscpy(ident->drv.driver_ver_str, UTS_RELEASE,
545 sizeof(ident->drv.driver_ver_str));
546
547 mutex_lock(&ionic->dev_cmd_lock);
548
549 sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data));
550 memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz);
551
552 ionic_dev_cmd_identify(idev, IONIC_DEV_IDENTITY_VERSION_2);
553 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
554 if (!err) {
555 sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data));
556 memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz);
557 }
558 mutex_unlock(&ionic->dev_cmd_lock);
559
560 if (err) {
561 dev_err(ionic->dev, "Cannot identify ionic: %d\n", err);
562 goto err_out;
563 }
564
565 if (isprint(idev->dev_info.fw_version[0]) &&
566 isascii(idev->dev_info.fw_version[0]))
567 dev_info(ionic->dev, "FW: %.*s\n",
568 (int)(sizeof(idev->dev_info.fw_version) - 1),
569 idev->dev_info.fw_version);
570 else
571 dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n",
572 (u8)idev->dev_info.fw_version[0],
573 (u8)idev->dev_info.fw_version[1],
574 (u8)idev->dev_info.fw_version[2],
575 (u8)idev->dev_info.fw_version[3]);
576
577 err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC,
578 &ionic->ident.lif);
579 if (err) {
580 dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err);
581 goto err_out;
582 }
583
584 return 0;
585
586 err_out:
587 return err;
588 }
589
ionic_init(struct ionic * ionic)590 int ionic_init(struct ionic *ionic)
591 {
592 struct ionic_dev *idev = &ionic->idev;
593 int err;
594
595 mutex_lock(&ionic->dev_cmd_lock);
596 ionic_dev_cmd_init(idev);
597 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
598 mutex_unlock(&ionic->dev_cmd_lock);
599
600 return err;
601 }
602
ionic_reset(struct ionic * ionic)603 int ionic_reset(struct ionic *ionic)
604 {
605 struct ionic_dev *idev = &ionic->idev;
606 int err;
607
608 if (!ionic_is_fw_running(idev))
609 return 0;
610
611 mutex_lock(&ionic->dev_cmd_lock);
612 ionic_dev_cmd_reset(idev);
613 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
614 mutex_unlock(&ionic->dev_cmd_lock);
615
616 return err;
617 }
618
ionic_port_identify(struct ionic * ionic)619 int ionic_port_identify(struct ionic *ionic)
620 {
621 struct ionic_identity *ident = &ionic->ident;
622 struct ionic_dev *idev = &ionic->idev;
623 size_t sz;
624 int err;
625
626 mutex_lock(&ionic->dev_cmd_lock);
627
628 ionic_dev_cmd_port_identify(idev);
629 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
630 if (!err) {
631 sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data));
632 memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz);
633 }
634
635 mutex_unlock(&ionic->dev_cmd_lock);
636
637 return err;
638 }
639
ionic_port_init(struct ionic * ionic)640 int ionic_port_init(struct ionic *ionic)
641 {
642 struct ionic_identity *ident = &ionic->ident;
643 struct ionic_dev *idev = &ionic->idev;
644 size_t sz;
645 int err;
646
647 if (!idev->port_info) {
648 idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE);
649 idev->port_info = dma_alloc_coherent(ionic->dev,
650 idev->port_info_sz,
651 &idev->port_info_pa,
652 GFP_KERNEL);
653 if (!idev->port_info)
654 return -ENOMEM;
655 }
656
657 sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data));
658
659 mutex_lock(&ionic->dev_cmd_lock);
660
661 memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz);
662 ionic_dev_cmd_port_init(idev);
663 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
664
665 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP);
666 ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
667
668 mutex_unlock(&ionic->dev_cmd_lock);
669 if (err) {
670 dev_err(ionic->dev, "Failed to init port\n");
671 dma_free_coherent(ionic->dev, idev->port_info_sz,
672 idev->port_info, idev->port_info_pa);
673 idev->port_info = NULL;
674 idev->port_info_pa = 0;
675 }
676
677 return err;
678 }
679
ionic_port_reset(struct ionic * ionic)680 int ionic_port_reset(struct ionic *ionic)
681 {
682 struct ionic_dev *idev = &ionic->idev;
683 int err = 0;
684
685 if (!idev->port_info)
686 return 0;
687
688 if (ionic_is_fw_running(idev)) {
689 mutex_lock(&ionic->dev_cmd_lock);
690 ionic_dev_cmd_port_reset(idev);
691 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
692 mutex_unlock(&ionic->dev_cmd_lock);
693 }
694
695 dma_free_coherent(ionic->dev, idev->port_info_sz,
696 idev->port_info, idev->port_info_pa);
697
698 idev->port_info = NULL;
699 idev->port_info_pa = 0;
700
701 return err;
702 }
703
ionic_init_module(void)704 static int __init ionic_init_module(void)
705 {
706 int ret;
707
708 ionic_debugfs_create();
709 ret = ionic_bus_register_driver();
710 if (ret)
711 ionic_debugfs_destroy();
712
713 return ret;
714 }
715
ionic_cleanup_module(void)716 static void __exit ionic_cleanup_module(void)
717 {
718 ionic_bus_unregister_driver();
719 ionic_debugfs_destroy();
720
721 pr_info("%s removed\n", IONIC_DRV_NAME);
722 }
723
724 module_init(ionic_init_module);
725 module_exit(ionic_cleanup_module);
726