ionic_main.c

  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
 17MODULE_DESCRIPTION(IONIC_DRV_DESCRIPTION);
 18MODULE_AUTHOR("Shannon Nelson <shannon.nelson@amd.com>");
 19MODULE_LICENSE("GPL");
 20
 21static 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
 75int 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		return -EINVAL;
 85	case IONIC_RC_ENOSUPP:
 86		return -EOPNOTSUPP;
 87	case IONIC_RC_EPERM:
 88		return -EPERM;
 89	case IONIC_RC_ENOENT:
 90		return -ENOENT;
 91	case IONIC_RC_EAGAIN:
 92		return -EAGAIN;
 93	case IONIC_RC_ENOMEM:
 94		return -ENOMEM;
 95	case IONIC_RC_EFAULT:
 96		return -EFAULT;
 97	case IONIC_RC_EBUSY:
 98		return -EBUSY;
 99	case IONIC_RC_EEXIST:
100		return -EEXIST;
101	case IONIC_RC_ENOSPC:
102		return -ENOSPC;
103	case IONIC_RC_ERANGE:
104		return -ERANGE;
105	case IONIC_RC_BAD_ADDR:
106		return -EFAULT;
107	case IONIC_RC_EOPCODE:
108	case IONIC_RC_EINTR:
109	case IONIC_RC_DEV_CMD:
110	case IONIC_RC_ERROR:
111	case IONIC_RC_ERDMA:
112	case IONIC_RC_EIO:
113	default:
114		return -EIO;
115	}
116}
117EXPORT_SYMBOL_NS(ionic_error_to_errno, "NET_IONIC");
118
119static const char *ionic_opcode_to_str(enum ionic_cmd_opcode opcode)
120{
121	switch (opcode) {
122	case IONIC_CMD_NOP:
123		return "IONIC_CMD_NOP";
124	case IONIC_CMD_INIT:
125		return "IONIC_CMD_INIT";
126	case IONIC_CMD_RESET:
127		return "IONIC_CMD_RESET";
128	case IONIC_CMD_IDENTIFY:
129		return "IONIC_CMD_IDENTIFY";
130	case IONIC_CMD_GETATTR:
131		return "IONIC_CMD_GETATTR";
132	case IONIC_CMD_SETATTR:
133		return "IONIC_CMD_SETATTR";
134	case IONIC_CMD_PORT_IDENTIFY:
135		return "IONIC_CMD_PORT_IDENTIFY";
136	case IONIC_CMD_PORT_INIT:
137		return "IONIC_CMD_PORT_INIT";
138	case IONIC_CMD_PORT_RESET:
139		return "IONIC_CMD_PORT_RESET";
140	case IONIC_CMD_PORT_GETATTR:
141		return "IONIC_CMD_PORT_GETATTR";
142	case IONIC_CMD_PORT_SETATTR:
143		return "IONIC_CMD_PORT_SETATTR";
144	case IONIC_CMD_LIF_INIT:
145		return "IONIC_CMD_LIF_INIT";
146	case IONIC_CMD_LIF_RESET:
147		return "IONIC_CMD_LIF_RESET";
148	case IONIC_CMD_LIF_IDENTIFY:
149		return "IONIC_CMD_LIF_IDENTIFY";
150	case IONIC_CMD_LIF_SETATTR:
151		return "IONIC_CMD_LIF_SETATTR";
152	case IONIC_CMD_LIF_GETATTR:
153		return "IONIC_CMD_LIF_GETATTR";
154	case IONIC_CMD_LIF_SETPHC:
155		return "IONIC_CMD_LIF_SETPHC";
156	case IONIC_CMD_RX_MODE_SET:
157		return "IONIC_CMD_RX_MODE_SET";
158	case IONIC_CMD_RX_FILTER_ADD:
159		return "IONIC_CMD_RX_FILTER_ADD";
160	case IONIC_CMD_RX_FILTER_DEL:
161		return "IONIC_CMD_RX_FILTER_DEL";
162	case IONIC_CMD_Q_IDENTIFY:
163		return "IONIC_CMD_Q_IDENTIFY";
164	case IONIC_CMD_Q_INIT:
165		return "IONIC_CMD_Q_INIT";
166	case IONIC_CMD_Q_CONTROL:
167		return "IONIC_CMD_Q_CONTROL";
168	case IONIC_CMD_RDMA_RESET_LIF:
169		return "IONIC_CMD_RDMA_RESET_LIF";
170	case IONIC_CMD_RDMA_CREATE_EQ:
171		return "IONIC_CMD_RDMA_CREATE_EQ";
172	case IONIC_CMD_RDMA_CREATE_CQ:
173		return "IONIC_CMD_RDMA_CREATE_CQ";
174	case IONIC_CMD_RDMA_CREATE_ADMINQ:
175		return "IONIC_CMD_RDMA_CREATE_ADMINQ";
176	case IONIC_CMD_FW_DOWNLOAD:
177		return "IONIC_CMD_FW_DOWNLOAD";
178	case IONIC_CMD_FW_CONTROL:
179		return "IONIC_CMD_FW_CONTROL";
180	case IONIC_CMD_FW_DOWNLOAD_V1:
181		return "IONIC_CMD_FW_DOWNLOAD_V1";
182	case IONIC_CMD_FW_CONTROL_V1:
183		return "IONIC_CMD_FW_CONTROL_V1";
184	case IONIC_CMD_VF_GETATTR:
185		return "IONIC_CMD_VF_GETATTR";
186	case IONIC_CMD_VF_SETATTR:
187		return "IONIC_CMD_VF_SETATTR";
188	default:
189		return "DEVCMD_UNKNOWN";
190	}
191}
192
193static void ionic_adminq_flush(struct ionic_lif *lif)
194{
195	struct ionic_admin_desc_info *desc_info;
196	struct ionic_admin_cmd *desc;
197	unsigned long irqflags;
198	struct ionic_queue *q;
199
200	spin_lock_irqsave(&lif->adminq_lock, irqflags);
201	if (!lif->adminqcq) {
202		spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
203		return;
204	}
205
206	q = &lif->adminqcq->q;
207
208	while (q->tail_idx != q->head_idx) {
209		desc = &q->adminq[q->tail_idx];
210		desc_info = &q->admin_info[q->tail_idx];
211		memset(desc, 0, sizeof(union ionic_adminq_cmd));
212		desc_info->ctx = NULL;
213		q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
214	}
215	spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
216}
217
218void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode,
219				   u8 status, int err)
220{
221	const char *stat_str;
222
223	stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
224					 ionic_error_to_str(status);
225
226	netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n",
227		   ionic_opcode_to_str(opcode), opcode, stat_str, err);
228}
229
230static int ionic_adminq_check_err(struct ionic_lif *lif,
231				  struct ionic_admin_ctx *ctx,
232				  const bool timeout,
233				  const bool do_msg)
234{
235	int err = 0;
236
237	if (ctx->comp.comp.status || timeout) {
238		err = timeout ? -ETIMEDOUT :
239				ionic_error_to_errno(ctx->comp.comp.status);
240
241		if (do_msg)
242			ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode,
243						      ctx->comp.comp.status, err);
244
245		if (timeout)
246			ionic_adminq_flush(lif);
247	}
248
249	return err;
250}
251
252bool ionic_notifyq_service(struct ionic_cq *cq)
253{
254	struct ionic_deferred_work *work;
255	union ionic_notifyq_comp *comp;
256	struct net_device *netdev;
257	struct ionic_queue *q;
258	struct ionic_lif *lif;
259	u64 eid;
260
261	comp = &((union ionic_notifyq_comp *)cq->base)[cq->tail_idx];
262
263	q = cq->bound_q;
264	lif = q->admin_info[0].ctx;
265	netdev = lif->netdev;
266	eid = le64_to_cpu(comp->event.eid);
267
268	/* Have we run out of new completions to process? */
269	if ((s64)(eid - lif->last_eid) <= 0)
270		return false;
271
272	lif->last_eid = eid;
273
274	dev_dbg(lif->ionic->dev, "notifyq event:\n");
275	dynamic_hex_dump("event ", DUMP_PREFIX_OFFSET, 16, 1,
276			 comp, sizeof(*comp), true);
277
278	switch (le16_to_cpu(comp->event.ecode)) {
279	case IONIC_EVENT_LINK_CHANGE:
280		ionic_link_status_check_request(lif, CAN_NOT_SLEEP);
281		break;
282	case IONIC_EVENT_RESET:
283		if (lif->ionic->idev.fw_status_ready &&
284		    !test_bit(IONIC_LIF_F_FW_RESET, lif->state) &&
285		    !test_and_set_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) {
286			work = kzalloc(sizeof(*work), GFP_ATOMIC);
287			if (!work) {
288				netdev_err(lif->netdev, "Reset event dropped\n");
289				clear_bit(IONIC_LIF_F_FW_STOPPING, lif->state);
290			} else {
291				work->type = IONIC_DW_TYPE_LIF_RESET;
292				ionic_lif_deferred_enqueue(lif, work);
293			}
294		}
295		break;
296	default:
297		netdev_warn(netdev, "Notifyq event ecode=%d eid=%lld\n",
298			    comp->event.ecode, eid);
299		break;
300	}
301
302	return true;
303}
304
305bool ionic_adminq_service(struct ionic_cq *cq)
306{
307	struct ionic_admin_desc_info *desc_info;
308	struct ionic_queue *q = cq->bound_q;
309	struct ionic_admin_comp *comp;
310	u16 index;
311
312	comp = &((struct ionic_admin_comp *)cq->base)[cq->tail_idx];
313
314	if (!color_match(comp->color, cq->done_color))
315		return false;
316
317	/* check for empty queue */
318	if (q->tail_idx == q->head_idx)
319		return false;
320
321	do {
322		desc_info = &q->admin_info[q->tail_idx];
323		index = q->tail_idx;
324		q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1);
325		if (likely(desc_info->ctx)) {
326			struct ionic_admin_ctx *ctx = desc_info->ctx;
327
328			memcpy(&ctx->comp, comp, sizeof(*comp));
329
330			dev_dbg(q->dev, "comp admin queue command:\n");
331			dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1,
332					 &ctx->comp, sizeof(ctx->comp), true);
333			complete_all(&ctx->work);
334			desc_info->ctx = NULL;
335		}
336	} while (index != le16_to_cpu(comp->comp_index));
337
338	return true;
339}
340
341bool ionic_adminq_poke_doorbell(struct ionic_queue *q)
342{
343	struct ionic_lif *lif = q->lif;
344	unsigned long now, then, dif;
345	unsigned long irqflags;
346
347	spin_lock_irqsave(&lif->adminq_lock, irqflags);
348
349	if (q->tail_idx == q->head_idx) {
350		spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
351		return false;
352	}
353
354	now = READ_ONCE(jiffies);
355	then = q->dbell_jiffies;
356	dif = now - then;
357
358	if (dif > q->dbell_deadline) {
359		ionic_dbell_ring(q->lif->kern_dbpage, q->hw_type,
360				 q->dbval | q->head_idx);
361
362		q->dbell_jiffies = now;
363	}
364
365	spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
366
367	return true;
368}
369
370int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
371{
372	struct ionic_admin_desc_info *desc_info;
373	struct ionic_admin_cmd *desc;
374	unsigned long irqflags;
375	struct ionic_queue *q;
376	int err = 0;
377
378	spin_lock_irqsave(&lif->adminq_lock, irqflags);
379	if (!lif->adminqcq) {
380		spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
381		return -EIO;
382	}
383
384	q = &lif->adminqcq->q;
385
386	if (!ionic_q_has_space(q, 1)) {
387		err = -ENOSPC;
388		goto err_out;
389	}
390
391	err = ionic_heartbeat_check(lif->ionic);
392	if (err)
393		goto err_out;
394
395	desc_info = &q->admin_info[q->head_idx];
396	desc_info->ctx = ctx;
397
398	desc = &q->adminq[q->head_idx];
399	memcpy(desc, &ctx->cmd, sizeof(ctx->cmd));
400
401	dev_dbg(&lif->netdev->dev, "post admin queue command:\n");
402	dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1,
403			 &ctx->cmd, sizeof(ctx->cmd), true);
404
405	ionic_q_post(q, true);
406
407err_out:
408	spin_unlock_irqrestore(&lif->adminq_lock, irqflags);
409
410	return err;
411}
412
413int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx,
414		      const int err, const bool do_msg)
415{
416	struct net_device *netdev = lif->netdev;
417	unsigned long time_limit;
418	unsigned long time_start;
419	unsigned long time_done;
420	unsigned long remaining;
421	const char *name;
422
423	name = ionic_opcode_to_str(ctx->cmd.cmd.opcode);
424
425	if (err) {
426		if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state))
427			netdev_err(netdev, "Posting of %s (%d) failed: %d\n",
428				   name, ctx->cmd.cmd.opcode, err);
429		ctx->comp.comp.status = IONIC_RC_ERROR;
430		return err;
431	}
432
433	time_start = jiffies;
434	time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT;
435	do {
436		remaining = wait_for_completion_timeout(&ctx->work,
437							IONIC_ADMINQ_TIME_SLICE);
438
439		/* check for done */
440		if (remaining)
441			break;
442
443		/* force a check of FW status and break out if FW reset */
444		ionic_heartbeat_check(lif->ionic);
445		if ((test_bit(IONIC_LIF_F_FW_RESET, lif->state) &&
446		     !lif->ionic->idev.fw_status_ready) ||
447		    test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) {
448			if (do_msg)
449				netdev_warn(netdev, "%s (%d) interrupted, FW in reset\n",
450					    name, ctx->cmd.cmd.opcode);
451			ctx->comp.comp.status = IONIC_RC_ERROR;
452			return -ENXIO;
453		}
454
455	} while (time_before(jiffies, time_limit));
456	time_done = jiffies;
457
458	dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n",
459		__func__, jiffies_to_msecs(time_done - time_start));
460
461	return ionic_adminq_check_err(lif, ctx,
462				      time_after_eq(time_done, time_limit),
463				      do_msg);
464}
465
466static int __ionic_adminq_post_wait(struct ionic_lif *lif,
467				    struct ionic_admin_ctx *ctx,
468				    const bool do_msg)
469{
470	int err;
471
472	if (!ionic_is_fw_running(&lif->ionic->idev))
473		return 0;
474
475	err = ionic_adminq_post(lif, ctx);
476
477	return ionic_adminq_wait(lif, ctx, err, do_msg);
478}
479
480int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
481{
482	return __ionic_adminq_post_wait(lif, ctx, true);
483}
484EXPORT_SYMBOL_NS(ionic_adminq_post_wait, "NET_IONIC");
485
486int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx)
487{
488	return __ionic_adminq_post_wait(lif, ctx, false);
489}
490
491static void ionic_dev_cmd_clean(struct ionic *ionic)
492{
493	struct ionic_dev *idev = &ionic->idev;
494
495	if (!idev->dev_cmd_regs)
496		return;
497
498	iowrite32(0, &idev->dev_cmd_regs->doorbell);
499	memset_io(&idev->dev_cmd_regs->cmd, 0, sizeof(idev->dev_cmd_regs->cmd));
500}
501
502void ionic_dev_cmd_dev_err_print(struct ionic *ionic, u8 opcode, u8 status,
503				 int err)
504{
505	const char *stat_str;
506
507	stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" :
508					 ionic_error_to_str(status);
509
510	dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n",
511		ionic_opcode_to_str(opcode), opcode, stat_str, err);
512}
513
514static int __ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds,
515				const bool do_msg)
516{
517	struct ionic_dev *idev = &ionic->idev;
518	unsigned long start_time;
519	unsigned long max_wait;
520	unsigned long duration;
521	bool fw_up;
522	int opcode;
523	bool done;
524	int err;
525
526	/* Wait for dev cmd to complete, retrying if we get EAGAIN,
527	 * but don't wait any longer than max_seconds.
528	 */
529	max_wait = jiffies + (max_seconds * HZ);
530try_again:
531	done = false;
532	opcode = idev->opcode;
533	start_time = jiffies;
534	for (fw_up = ionic_is_fw_running(idev);
535	     !done && fw_up && time_before(jiffies, max_wait);
536	     fw_up = ionic_is_fw_running(idev)) {
537		done = ionic_dev_cmd_done(idev);
538		if (done)
539			break;
540		usleep_range(100, 200);
541	}
542	duration = jiffies - start_time;
543
544	dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n",
545		ionic_opcode_to_str(opcode), opcode,
546		done, duration / HZ, duration);
547
548	if (!done && !fw_up) {
549		ionic_dev_cmd_clean(ionic);
550		dev_warn(ionic->dev, "DEVCMD %s (%d) interrupted - FW is down\n",
551			 ionic_opcode_to_str(opcode), opcode);
552		return -ENXIO;
553	}
554
555	if (!done && !time_before(jiffies, max_wait)) {
556		ionic_dev_cmd_clean(ionic);
557		dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n",
558			 ionic_opcode_to_str(opcode), opcode, max_seconds);
559		return -ETIMEDOUT;
560	}
561
562	err = ionic_dev_cmd_status(&ionic->idev);
563	if (err) {
564		if (err == IONIC_RC_EAGAIN &&
565		    time_before(jiffies, (max_wait - HZ))) {
566			dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n",
567				ionic_opcode_to_str(opcode), opcode,
568				ionic_error_to_str(err), err);
569
570			iowrite32(0, &idev->dev_cmd_regs->done);
571			msleep(1000);
572			iowrite32(1, &idev->dev_cmd_regs->doorbell);
573			goto try_again;
574		}
575
576		if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN))
577			if (do_msg)
578				ionic_dev_cmd_dev_err_print(ionic, opcode, err,
579							    ionic_error_to_errno(err));
580
581		return ionic_error_to_errno(err);
582	}
583
584	ionic_dev_cmd_clean(ionic);
585
586	return 0;
587}
588
589int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds)
590{
591	return __ionic_dev_cmd_wait(ionic, max_seconds, true);
592}
593
594int ionic_dev_cmd_wait_nomsg(struct ionic *ionic, unsigned long max_seconds)
595{
596	return __ionic_dev_cmd_wait(ionic, max_seconds, false);
597}
598
599int ionic_setup(struct ionic *ionic)
600{
601	int err;
602
603	err = ionic_dev_setup(ionic);
604	if (err)
605		return err;
606	ionic_reset(ionic);
607
608	return 0;
609}
610
611int ionic_identify(struct ionic *ionic)
612{
613	struct ionic_identity *ident = &ionic->ident;
614	struct ionic_dev *idev = &ionic->idev;
615	size_t sz;
616	int err;
617
618	memset(ident, 0, sizeof(*ident));
619
620	ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX);
621	strscpy(ident->drv.driver_ver_str, UTS_RELEASE,
622		sizeof(ident->drv.driver_ver_str));
623
624	mutex_lock(&ionic->dev_cmd_lock);
625
626	sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data));
627	memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz);
628
629	ionic_dev_cmd_identify(idev, IONIC_DEV_IDENTITY_VERSION_2);
630	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
631	if (!err) {
632		sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data));
633		memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz);
634	}
635	mutex_unlock(&ionic->dev_cmd_lock);
636
637	if (err) {
638		dev_err(ionic->dev, "Cannot identify ionic: %d\n", err);
639		goto err_out;
640	}
641
642	if (isprint(idev->dev_info.fw_version[0]) &&
643	    isascii(idev->dev_info.fw_version[0]))
644		dev_info(ionic->dev, "FW: %.*s\n",
645			 (int)(sizeof(idev->dev_info.fw_version) - 1),
646			 idev->dev_info.fw_version);
647	else
648		dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n",
649			 (u8)idev->dev_info.fw_version[0],
650			 (u8)idev->dev_info.fw_version[1],
651			 (u8)idev->dev_info.fw_version[2],
652			 (u8)idev->dev_info.fw_version[3]);
653
654	err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC,
655				 &ionic->ident.lif);
656	if (err) {
657		dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err);
658		goto err_out;
659	}
660
661	return 0;
662
663err_out:
664	return err;
665}
666
667int ionic_init(struct ionic *ionic)
668{
669	struct ionic_dev *idev = &ionic->idev;
670	int err;
671
672	mutex_lock(&ionic->dev_cmd_lock);
673	ionic_dev_cmd_init(idev);
674	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
675	mutex_unlock(&ionic->dev_cmd_lock);
676
677	return err;
678}
679
680int ionic_reset(struct ionic *ionic)
681{
682	struct ionic_dev *idev = &ionic->idev;
683	int err;
684
685	if (!ionic_is_fw_running(idev))
686		return 0;
687
688	mutex_lock(&ionic->dev_cmd_lock);
689	ionic_dev_cmd_reset(idev);
690	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
691	mutex_unlock(&ionic->dev_cmd_lock);
692
693	return err;
694}
695
696int ionic_port_identify(struct ionic *ionic)
697{
698	struct ionic_identity *ident = &ionic->ident;
699	struct ionic_dev *idev = &ionic->idev;
700	size_t sz;
701	int err;
702
703	mutex_lock(&ionic->dev_cmd_lock);
704
705	ionic_dev_cmd_port_identify(idev);
706	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
707	if (!err) {
708		sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data));
709		memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz);
710	}
711
712	mutex_unlock(&ionic->dev_cmd_lock);
713
714	return err;
715}
716
717int ionic_port_init(struct ionic *ionic)
718{
719	struct ionic_identity *ident = &ionic->ident;
720	struct ionic_dev *idev = &ionic->idev;
721	size_t sz;
722	int err;
723
724	if (!idev->port_info) {
725		idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE);
726		idev->port_info = dma_alloc_coherent(ionic->dev,
727						     idev->port_info_sz,
728						     &idev->port_info_pa,
729						     GFP_KERNEL);
730		if (!idev->port_info)
731			return -ENOMEM;
732	}
733
734	sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data));
735
736	mutex_lock(&ionic->dev_cmd_lock);
737
738	memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz);
739	ionic_dev_cmd_port_init(idev);
740	err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
741
742	ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP);
743	ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
744
745	mutex_unlock(&ionic->dev_cmd_lock);
746	if (err) {
747		dev_err(ionic->dev, "Failed to init port\n");
748		dma_free_coherent(ionic->dev, idev->port_info_sz,
749				  idev->port_info, idev->port_info_pa);
750		idev->port_info = NULL;
751		idev->port_info_pa = 0;
752	}
753
754	return err;
755}
756
757int ionic_port_reset(struct ionic *ionic)
758{
759	struct ionic_dev *idev = &ionic->idev;
760	int err = 0;
761
762	if (!idev->port_info)
763		return 0;
764
765	if (ionic_is_fw_running(idev)) {
766		mutex_lock(&ionic->dev_cmd_lock);
767		ionic_dev_cmd_port_reset(idev);
768		err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT);
769		mutex_unlock(&ionic->dev_cmd_lock);
770	}
771
772	dma_free_coherent(ionic->dev, idev->port_info_sz,
773			  idev->port_info, idev->port_info_pa);
774
775	idev->port_info = NULL;
776	idev->port_info_pa = 0;
777
778	return err;
779}
780
781static int __init ionic_init_module(void)
782{
783	int ret;
784
785	ionic_debugfs_create();
786	ret = ionic_bus_register_driver();
787	if (ret)
788		ionic_debugfs_destroy();
789
790	return ret;
791}
792
793static void __exit ionic_cleanup_module(void)
794{
795	ionic_bus_unregister_driver();
796	ionic_debugfs_destroy();
797
798	pr_info("%s removed\n", IONIC_DRV_NAME);
799}
800
801module_init(ionic_init_module);
802module_exit(ionic_cleanup_module);