bfa_ioc.c 61.0 KB
Newer Older
1
/*
K
Krishna Gudipati 已提交
2
 * Copyright (c) 2005-2010 Brocade Communications Systems, Inc.
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
 * All rights reserved
 * www.brocade.com
 *
 * Linux driver for Brocade Fibre Channel Host Bus Adapter.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License (GPL) Version 2 as
 * published by the Free Software Foundation
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 */

K
Krishna Gudipati 已提交
18 19 20 21 22
#include "bfa_ioc.h"
#include "bfi_ctreg.h"
#include "bfa_defs.h"
#include "bfa_defs_svc.h"
#include "bfad_drv.h"
23

24
BFA_TRC_FILE(CNA, IOC);
25 26 27 28

/**
 * IOC local definitions
 */
K
Krishna Gudipati 已提交
29 30 31 32 33
#define BFA_IOC_TOV		3000	/* msecs */
#define BFA_IOC_HWSEM_TOV	500	/* msecs */
#define BFA_IOC_HB_TOV		500	/* msecs */
#define BFA_IOC_HWINIT_MAX	2
#define BFA_IOC_TOV_RECOVER	 BFA_IOC_HB_TOV
34 35 36 37 38 39

#define bfa_ioc_timer_start(__ioc)					\
	bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->ioc_timer,	\
			bfa_ioc_timeout, (__ioc), BFA_IOC_TOV)
#define bfa_ioc_timer_stop(__ioc)   bfa_timer_stop(&(__ioc)->ioc_timer)

K
Krishna Gudipati 已提交
40 41 42 43 44
#define bfa_hb_timer_start(__ioc)					\
	bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->hb_timer,		\
			bfa_ioc_hb_check, (__ioc), BFA_IOC_HB_TOV)
#define bfa_hb_timer_stop(__ioc)	bfa_timer_stop(&(__ioc)->hb_timer)

45 46 47 48 49 50 51
#define BFA_DBG_FWTRC_ENTS	(BFI_IOC_TRC_ENTS)
#define BFA_DBG_FWTRC_LEN					\
	(BFA_DBG_FWTRC_ENTS * sizeof(struct bfa_trc_s) +	\
	 (sizeof(struct bfa_trc_mod_s) -			\
	  BFA_TRC_MAX * sizeof(struct bfa_trc_s)))
#define BFA_DBG_FWTRC_OFF(_fn)	(BFI_IOC_TRC_OFF + BFA_DBG_FWTRC_LEN * (_fn))

52 53 54 55
/**
 * Asic specific macros : see bfa_hw_cb.c and bfa_hw_ct.c for details.
 */

K
Krishna Gudipati 已提交
56
#define bfa_ioc_firmware_lock(__ioc)			\
57
			((__ioc)->ioc_hwif->ioc_firmware_lock(__ioc))
K
Krishna Gudipati 已提交
58
#define bfa_ioc_firmware_unlock(__ioc)			\
59 60 61
			((__ioc)->ioc_hwif->ioc_firmware_unlock(__ioc))
#define bfa_ioc_reg_init(__ioc) ((__ioc)->ioc_hwif->ioc_reg_init(__ioc))
#define bfa_ioc_map_port(__ioc) ((__ioc)->ioc_hwif->ioc_map_port(__ioc))
K
Krishna Gudipati 已提交
62
#define bfa_ioc_notify_hbfail(__ioc)			\
63 64
			((__ioc)->ioc_hwif->ioc_notify_hbfail(__ioc))

K
Krishna Gudipati 已提交
65 66 67 68 69 70 71 72 73 74 75 76 77 78
#ifdef BFA_IOC_IS_UEFI
#define bfa_ioc_is_bios_optrom(__ioc) (0)
#define bfa_ioc_is_uefi(__ioc) BFA_IOC_IS_UEFI
#else
#define bfa_ioc_is_bios_optrom(__ioc)	\
	(bfa_cb_image_get_size(BFA_IOC_FWIMG_TYPE(__ioc)) < BFA_IOC_FWIMG_MINSZ)
#define bfa_ioc_is_uefi(__ioc) (0)
#endif

#define bfa_ioc_mbox_cmd_pending(__ioc)		\
			(!list_empty(&((__ioc)->mbox_mod.cmd_q)) || \
			bfa_reg_read((__ioc)->ioc_regs.hfn_mbox_cmd))

bfa_boolean_t bfa_auto_recover = BFA_TRUE;
79 80 81 82

/*
 * forward declarations
 */
K
Krishna Gudipati 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102
static void bfa_ioc_hw_sem_get(struct bfa_ioc_s *ioc);
static void bfa_ioc_hw_sem_get_cancel(struct bfa_ioc_s *ioc);
static void bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force);
static void bfa_ioc_timeout(void *ioc);
static void bfa_ioc_send_enable(struct bfa_ioc_s *ioc);
static void bfa_ioc_send_disable(struct bfa_ioc_s *ioc);
static void bfa_ioc_send_getattr(struct bfa_ioc_s *ioc);
static void bfa_ioc_hb_monitor(struct bfa_ioc_s *ioc);
static void bfa_ioc_hb_stop(struct bfa_ioc_s *ioc);
static void bfa_ioc_reset(struct bfa_ioc_s *ioc, bfa_boolean_t force);
static void bfa_ioc_mbox_poll(struct bfa_ioc_s *ioc);
static void bfa_ioc_mbox_hbfail(struct bfa_ioc_s *ioc);
static void bfa_ioc_recover(struct bfa_ioc_s *ioc);
static void bfa_ioc_check_attr_wwns(struct bfa_ioc_s *ioc);
static void bfa_ioc_disable_comp(struct bfa_ioc_s *ioc);
static void bfa_ioc_lpu_stop(struct bfa_ioc_s *ioc);
static void bfa_ioc_pf_enabled(struct bfa_ioc_s *ioc);
static void bfa_ioc_pf_disabled(struct bfa_ioc_s *ioc);
static void bfa_ioc_pf_failed(struct bfa_ioc_s *ioc);
static void bfa_ioc_pf_fwmismatch(struct bfa_ioc_s *ioc);
103 104

/**
K
Krishna Gudipati 已提交
105
 *  hal_ioc_sm
106 107 108
 */

/**
K
Krishna Gudipati 已提交
109
 * IOC state machine definitions/declarations
110 111
 */
enum ioc_event {
K
Krishna Gudipati 已提交
112 113 114 115 116 117 118 119 120 121 122
	IOC_E_RESET		= 1,	/*  IOC reset request		*/
	IOC_E_ENABLE		= 2,	/*  IOC enable request		*/
	IOC_E_DISABLE		= 3,	/*  IOC disable request	*/
	IOC_E_DETACH		= 4,	/*  driver detach cleanup	*/
	IOC_E_ENABLED		= 5,	/*  f/w enabled		*/
	IOC_E_FWRSP_GETATTR	= 6,	/*  IOC get attribute response	*/
	IOC_E_DISABLED		= 7,	/*  f/w disabled		*/
	IOC_E_FAILED		= 8,	/*  failure notice by iocpf sm	*/
	IOC_E_HBFAIL		= 9,	/*  heartbeat failure		*/
	IOC_E_HWERROR		= 10,	/*  hardware error interrupt	*/
	IOC_E_TIMEOUT		= 11,	/*  timeout			*/
123 124
};

K
Krishna Gudipati 已提交
125
bfa_fsm_state_decl(bfa_ioc, uninit, struct bfa_ioc_s, enum ioc_event);
126 127 128 129 130
bfa_fsm_state_decl(bfa_ioc, reset, struct bfa_ioc_s, enum ioc_event);
bfa_fsm_state_decl(bfa_ioc, enabling, struct bfa_ioc_s, enum ioc_event);
bfa_fsm_state_decl(bfa_ioc, getattr, struct bfa_ioc_s, enum ioc_event);
bfa_fsm_state_decl(bfa_ioc, op, struct bfa_ioc_s, enum ioc_event);
bfa_fsm_state_decl(bfa_ioc, initfail, struct bfa_ioc_s, enum ioc_event);
K
Krishna Gudipati 已提交
131
bfa_fsm_state_decl(bfa_ioc, fail, struct bfa_ioc_s, enum ioc_event);
132 133 134 135
bfa_fsm_state_decl(bfa_ioc, disabling, struct bfa_ioc_s, enum ioc_event);
bfa_fsm_state_decl(bfa_ioc, disabled, struct bfa_ioc_s, enum ioc_event);

static struct bfa_sm_table_s ioc_sm_table[] = {
K
Krishna Gudipati 已提交
136
	{BFA_SM(bfa_ioc_sm_uninit), BFA_IOC_UNINIT},
137
	{BFA_SM(bfa_ioc_sm_reset), BFA_IOC_RESET},
K
Krishna Gudipati 已提交
138
	{BFA_SM(bfa_ioc_sm_enabling), BFA_IOC_ENABLING},
139 140 141
	{BFA_SM(bfa_ioc_sm_getattr), BFA_IOC_GETATTR},
	{BFA_SM(bfa_ioc_sm_op), BFA_IOC_OPERATIONAL},
	{BFA_SM(bfa_ioc_sm_initfail), BFA_IOC_INITFAIL},
K
Krishna Gudipati 已提交
142
	{BFA_SM(bfa_ioc_sm_fail), BFA_IOC_FAIL},
143 144 145 146
	{BFA_SM(bfa_ioc_sm_disabling), BFA_IOC_DISABLING},
	{BFA_SM(bfa_ioc_sm_disabled), BFA_IOC_DISABLED},
};

K
Krishna Gudipati 已提交
147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264
/**
 * IOCPF state machine definitions/declarations
 */

#define bfa_iocpf_timer_start(__ioc)					\
	bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->ioc_timer,	\
			bfa_iocpf_timeout, (__ioc), BFA_IOC_TOV)
#define bfa_iocpf_timer_stop(__ioc)	bfa_timer_stop(&(__ioc)->ioc_timer)

#define bfa_iocpf_recovery_timer_start(__ioc)				\
	bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->ioc_timer,	\
			bfa_iocpf_timeout, (__ioc), BFA_IOC_TOV_RECOVER)

#define bfa_sem_timer_start(__ioc)					\
	bfa_timer_begin((__ioc)->timer_mod, &(__ioc)->sem_timer,	\
			bfa_iocpf_sem_timeout, (__ioc), BFA_IOC_HWSEM_TOV)
#define bfa_sem_timer_stop(__ioc)	bfa_timer_stop(&(__ioc)->sem_timer)

/*
 * Forward declareations for iocpf state machine
 */
static void bfa_iocpf_enable(struct bfa_ioc_s *ioc);
static void bfa_iocpf_disable(struct bfa_ioc_s *ioc);
static void bfa_iocpf_fail(struct bfa_ioc_s *ioc);
static void bfa_iocpf_initfail(struct bfa_ioc_s *ioc);
static void bfa_iocpf_getattrfail(struct bfa_ioc_s *ioc);
static void bfa_iocpf_stop(struct bfa_ioc_s *ioc);
static void bfa_iocpf_timeout(void *ioc_arg);
static void bfa_iocpf_sem_timeout(void *ioc_arg);

/**
 * IOCPF state machine events
 */
enum iocpf_event {
	IOCPF_E_ENABLE		= 1,	/*  IOCPF enable request	*/
	IOCPF_E_DISABLE		= 2,	/*  IOCPF disable request	*/
	IOCPF_E_STOP		= 3,	/*  stop on driver detach	*/
	IOCPF_E_FWREADY		= 4,	/*  f/w initialization done	*/
	IOCPF_E_FWRSP_ENABLE	= 5,	/*  enable f/w response	*/
	IOCPF_E_FWRSP_DISABLE	= 6,	/*  disable f/w response	*/
	IOCPF_E_FAIL		= 7,	/*  failure notice by ioc sm	*/
	IOCPF_E_INITFAIL	= 8,	/*  init fail notice by ioc sm	*/
	IOCPF_E_GETATTRFAIL	= 9,	/*  init fail notice by ioc sm	*/
	IOCPF_E_SEMLOCKED	= 10,	/*  h/w semaphore is locked	*/
	IOCPF_E_TIMEOUT		= 11,	/*  f/w response timeout	*/
};

/**
 * IOCPF states
 */
enum bfa_iocpf_state {
	BFA_IOCPF_RESET		= 1,	/*  IOC is in reset state */
	BFA_IOCPF_SEMWAIT	= 2,	/*  Waiting for IOC h/w semaphore */
	BFA_IOCPF_HWINIT	= 3,	/*  IOC h/w is being initialized */
	BFA_IOCPF_READY		= 4,	/*  IOCPF is initialized */
	BFA_IOCPF_INITFAIL	= 5,	/*  IOCPF failed */
	BFA_IOCPF_FAIL		= 6,	/*  IOCPF failed */
	BFA_IOCPF_DISABLING	= 7,	/*  IOCPF is being disabled */
	BFA_IOCPF_DISABLED	= 8,	/*  IOCPF is disabled */
	BFA_IOCPF_FWMISMATCH	= 9,	/*  IOC f/w different from drivers */
};

bfa_fsm_state_decl(bfa_iocpf, reset, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, fwcheck, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, mismatch, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, semwait, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, hwinit, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, enabling, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, ready, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, initfail, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, fail, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, disabling, struct bfa_iocpf_s, enum iocpf_event);
bfa_fsm_state_decl(bfa_iocpf, disabled, struct bfa_iocpf_s, enum iocpf_event);

static struct bfa_sm_table_s iocpf_sm_table[] = {
	{BFA_SM(bfa_iocpf_sm_reset), BFA_IOCPF_RESET},
	{BFA_SM(bfa_iocpf_sm_fwcheck), BFA_IOCPF_FWMISMATCH},
	{BFA_SM(bfa_iocpf_sm_mismatch), BFA_IOCPF_FWMISMATCH},
	{BFA_SM(bfa_iocpf_sm_semwait), BFA_IOCPF_SEMWAIT},
	{BFA_SM(bfa_iocpf_sm_hwinit), BFA_IOCPF_HWINIT},
	{BFA_SM(bfa_iocpf_sm_enabling), BFA_IOCPF_HWINIT},
	{BFA_SM(bfa_iocpf_sm_ready), BFA_IOCPF_READY},
	{BFA_SM(bfa_iocpf_sm_initfail), BFA_IOCPF_INITFAIL},
	{BFA_SM(bfa_iocpf_sm_fail), BFA_IOCPF_FAIL},
	{BFA_SM(bfa_iocpf_sm_disabling), BFA_IOCPF_DISABLING},
	{BFA_SM(bfa_iocpf_sm_disabled), BFA_IOCPF_DISABLED},
};

/**
 * IOC State Machine
 */

/**
 * Beginning state. IOC uninit state.
 */

static void
bfa_ioc_sm_uninit_entry(struct bfa_ioc_s *ioc)
{
}

/**
 * IOC is in uninit state.
 */
static void
bfa_ioc_sm_uninit(struct bfa_ioc_s *ioc, enum ioc_event event)
{
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_RESET:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_reset);
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}
265 266 267 268 269 270
/**
 * Reset entry actions -- initialize state machine
 */
static void
bfa_ioc_sm_reset_entry(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
271
	bfa_fsm_set_state(&ioc->iocpf, bfa_iocpf_sm_reset);
272 273 274
}

/**
K
Krishna Gudipati 已提交
275
 * IOC is in reset state.
276 277 278 279 280 281 282 283
 */
static void
bfa_ioc_sm_reset(struct bfa_ioc_s *ioc, enum ioc_event event)
{
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_ENABLE:
K
Krishna Gudipati 已提交
284
		bfa_fsm_set_state(ioc, bfa_ioc_sm_enabling);
285 286 287 288 289 290 291
		break;

	case IOC_E_DISABLE:
		bfa_ioc_disable_comp(ioc);
		break;

	case IOC_E_DETACH:
K
Krishna Gudipati 已提交
292
		bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
293 294 295 296 297 298 299
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}

K
Krishna Gudipati 已提交
300 301 302 303 304 305 306

static void
bfa_ioc_sm_enabling_entry(struct bfa_ioc_s *ioc)
{
	bfa_iocpf_enable(ioc);
}

307
/**
K
Krishna Gudipati 已提交
308 309
 * Host IOC function is being enabled, awaiting response from firmware.
 * Semaphore is acquired.
310 311
 */
static void
K
Krishna Gudipati 已提交
312
bfa_ioc_sm_enabling(struct bfa_ioc_s *ioc, enum ioc_event event)
313
{
K
Krishna Gudipati 已提交
314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_ENABLED:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_getattr);
		break;

	case IOC_E_FAILED:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_initfail);
		break;

	case IOC_E_HWERROR:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_initfail);
		bfa_iocpf_initfail(ioc);
		break;

	case IOC_E_DISABLE:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
		break;

	case IOC_E_DETACH:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
		bfa_iocpf_stop(ioc);
		break;

	case IOC_E_ENABLE:
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
bfa_ioc_sm_getattr_entry(struct bfa_ioc_s *ioc)
{
	bfa_ioc_timer_start(ioc);
	bfa_ioc_send_getattr(ioc);
353 354 355
}

/**
K
Krishna Gudipati 已提交
356
 * IOC configuration in progress. Timer is active.
357 358
 */
static void
K
Krishna Gudipati 已提交
359
bfa_ioc_sm_getattr(struct bfa_ioc_s *ioc, enum ioc_event event)
360 361 362 363
{
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
	case IOC_E_FWRSP_GETATTR:
		bfa_ioc_timer_stop(ioc);
		bfa_ioc_check_attr_wwns(ioc);
		bfa_fsm_set_state(ioc, bfa_ioc_sm_op);
		break;

	case IOC_E_FAILED:
		bfa_ioc_timer_stop(ioc);
		bfa_fsm_set_state(ioc, bfa_ioc_sm_initfail);
		break;

	case IOC_E_HWERROR:
		bfa_ioc_timer_stop(ioc);
		/* fall through */

	case IOC_E_TIMEOUT:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_initfail);
		bfa_iocpf_getattrfail(ioc);
382 383 384
		break;

	case IOC_E_DISABLE:
K
Krishna Gudipati 已提交
385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463
		bfa_ioc_timer_stop(ioc);
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
		break;

	case IOC_E_ENABLE:
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
bfa_ioc_sm_op_entry(struct bfa_ioc_s *ioc)
{
	struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;

	ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_OK);
	bfa_ioc_hb_monitor(ioc);
	BFA_LOG(KERN_INFO, bfad, log_level, "IOC enabled\n");
}

static void
bfa_ioc_sm_op(struct bfa_ioc_s *ioc, enum ioc_event event)
{
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_ENABLE:
		break;

	case IOC_E_DISABLE:
		bfa_ioc_hb_stop(ioc);
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
		break;

	case IOC_E_FAILED:
		bfa_ioc_hb_stop(ioc);
		bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
		break;

	case IOC_E_HWERROR:
		bfa_ioc_hb_stop(ioc);
		/* !!! fall through !!! */

	case IOC_E_HBFAIL:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_fail);
		bfa_iocpf_fail(ioc);
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
bfa_ioc_sm_disabling_entry(struct bfa_ioc_s *ioc)
{
	struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;
	bfa_iocpf_disable(ioc);
	BFA_LOG(KERN_INFO, bfad, log_level, "IOC disabled\n");
}

/**
 * IOC is being disabled
 */
static void
bfa_ioc_sm_disabling(struct bfa_ioc_s *ioc, enum ioc_event event)
{
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_DISABLED:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabled);
		break;

	case IOC_E_HWERROR:
464
		/*
K
Krishna Gudipati 已提交
465 466 467
		 * No state change.  Will move to disabled state
		 * after iocpf sm completes failure processing and
		 * moves to disabled state.
468
		 */
K
Krishna Gudipati 已提交
469 470
		bfa_iocpf_fail(ioc);
		break;
471

K
Krishna Gudipati 已提交
472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493
	default:
		bfa_sm_fault(ioc, event);
	}
}

/**
 * IOC disable completion entry.
 */
static void
bfa_ioc_sm_disabled_entry(struct bfa_ioc_s *ioc)
{
	bfa_ioc_disable_comp(ioc);
}

static void
bfa_ioc_sm_disabled(struct bfa_ioc_s *ioc, enum ioc_event event)
{
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_ENABLE:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_enabling);
494 495
		break;

K
Krishna Gudipati 已提交
496 497 498 499 500 501 502
	case IOC_E_DISABLE:
		ioc->cbfn->disable_cbfn(ioc->bfa);
		break;

	case IOC_E_DETACH:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
		bfa_iocpf_stop(ioc);
503 504 505 506 507 508 509
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}

K
Krishna Gudipati 已提交
510 511 512 513 514 515 516

static void
bfa_ioc_sm_initfail_entry(struct bfa_ioc_s *ioc)
{
	ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
}

517
/**
K
Krishna Gudipati 已提交
518
 * Hardware initialization failed.
519 520
 */
static void
K
Krishna Gudipati 已提交
521
bfa_ioc_sm_initfail(struct bfa_ioc_s *ioc, enum ioc_event event)
522
{
K
Krishna Gudipati 已提交
523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558
	bfa_trc(ioc, event);

	switch (event) {
	case IOC_E_ENABLED:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_getattr);
		break;

	case IOC_E_FAILED:
		/**
		 * Initialization failure during iocpf init retry.
		 */
		ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
		break;

	case IOC_E_DISABLE:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
		break;

	case IOC_E_DETACH:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
		bfa_iocpf_stop(ioc);
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
bfa_ioc_sm_fail_entry(struct bfa_ioc_s *ioc)
{
	struct list_head			*qe;
	struct bfa_ioc_hbfail_notify_s	*notify;
	struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;

559
	/**
K
Krishna Gudipati 已提交
560
	 * Notify driver and common modules registered for notification.
561
	 */
K
Krishna Gudipati 已提交
562 563 564 565
	ioc->cbfn->hbfail_cbfn(ioc->bfa);
	list_for_each(qe, &ioc->hb_notify_q) {
		notify = (struct bfa_ioc_hbfail_notify_s *) qe;
		notify->cbfn(notify->cbarg);
566
	}
K
Krishna Gudipati 已提交
567 568 569

	BFA_LOG(KERN_CRIT, bfad, log_level,
		"Heart Beat of IOC has failed\n");
570 571 572
}

/**
K
Krishna Gudipati 已提交
573
 * IOC failure.
574 575
 */
static void
K
Krishna Gudipati 已提交
576
bfa_ioc_sm_fail(struct bfa_ioc_s *ioc, enum ioc_event event)
577 578 579 580
{
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
581 582 583 584 585 586 587 588 589 590 591 592

	case IOC_E_FAILED:
		/**
		 * Initialization failure during iocpf recovery.
		 * !!! Fall through !!!
		 */
	case IOC_E_ENABLE:
		ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
		break;

	case IOC_E_ENABLED:
		bfa_fsm_set_state(ioc, bfa_ioc_sm_getattr);
593 594 595
		break;

	case IOC_E_DISABLE:
K
Krishna Gudipati 已提交
596 597 598 599
		bfa_fsm_set_state(ioc, bfa_ioc_sm_disabling);
		break;

	case IOC_E_HWERROR:
600
		/*
K
Krishna Gudipati 已提交
601
		 * HB failure notification, ignore.
602
		 */
K
Krishna Gudipati 已提交
603 604 605 606 607
		break;
	default:
		bfa_sm_fault(ioc, event);
	}
}
608

K
Krishna Gudipati 已提交
609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638


/**
 * IOCPF State Machine
 */


/**
 * Reset entry actions -- initialize state machine
 */
static void
bfa_iocpf_sm_reset_entry(struct bfa_iocpf_s *iocpf)
{
	iocpf->retry_count = 0;
	iocpf->auto_recover = bfa_auto_recover;
}

/**
 * Beginning state. IOC is in reset state.
 */
static void
bfa_iocpf_sm_reset(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
{
	struct bfa_ioc_s *ioc = iocpf->ioc;

	bfa_trc(ioc, event);

	switch (event) {
	case IOCPF_E_ENABLE:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fwcheck);
639 640
		break;

K
Krishna Gudipati 已提交
641
	case IOCPF_E_STOP:
642 643 644 645 646 647 648 649
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}

/**
K
Krishna Gudipati 已提交
650
 * Semaphore should be acquired for version check.
651 652
 */
static void
K
Krishna Gudipati 已提交
653
bfa_iocpf_sm_fwcheck_entry(struct bfa_iocpf_s *iocpf)
654
{
K
Krishna Gudipati 已提交
655
	bfa_ioc_hw_sem_get(iocpf->ioc);
656 657 658
}

/**
K
Krishna Gudipati 已提交
659
 * Awaiting h/w semaphore to continue with version check.
660 661
 */
static void
K
Krishna Gudipati 已提交
662
bfa_iocpf_sm_fwcheck(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
663
{
K
Krishna Gudipati 已提交
664 665
	struct bfa_ioc_s *ioc = iocpf->ioc;

666 667 668
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
669 670 671 672 673 674 675 676
	case IOCPF_E_SEMLOCKED:
		if (bfa_ioc_firmware_lock(ioc)) {
			iocpf->retry_count = 0;
			bfa_fsm_set_state(iocpf, bfa_iocpf_sm_hwinit);
		} else {
			bfa_ioc_hw_sem_release(ioc);
			bfa_fsm_set_state(iocpf, bfa_iocpf_sm_mismatch);
		}
677 678
		break;

K
Krishna Gudipati 已提交
679
	case IOCPF_E_DISABLE:
680
		bfa_ioc_hw_sem_get_cancel(ioc);
K
Krishna Gudipati 已提交
681 682 683 684 685 686 687
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
		bfa_ioc_pf_disabled(ioc);
		break;

	case IOCPF_E_STOP:
		bfa_ioc_hw_sem_get_cancel(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
688 689 690 691 692 693 694
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}

K
Krishna Gudipati 已提交
695 696 697
/**
 * Notify enable completion callback.
 */
698
static void
K
Krishna Gudipati 已提交
699
bfa_iocpf_sm_mismatch_entry(struct bfa_iocpf_s *iocpf)
700
{
K
Krishna Gudipati 已提交
701 702 703 704 705 706 707 708
	/*
	 * Call only the first time sm enters fwmismatch state.
	 */
	if (iocpf->retry_count == 0)
		bfa_ioc_pf_fwmismatch(iocpf->ioc);

	iocpf->retry_count++;
	bfa_iocpf_timer_start(iocpf->ioc);
709 710 711
}

/**
K
Krishna Gudipati 已提交
712
 * Awaiting firmware version match.
713 714
 */
static void
K
Krishna Gudipati 已提交
715
bfa_iocpf_sm_mismatch(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
716
{
K
Krishna Gudipati 已提交
717 718
	struct bfa_ioc_s *ioc = iocpf->ioc;

719 720 721
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
722 723
	case IOCPF_E_TIMEOUT:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fwcheck);
724 725
		break;

K
Krishna Gudipati 已提交
726 727 728 729 730
	case IOCPF_E_DISABLE:
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
		bfa_ioc_pf_disabled(ioc);
		break;
731

K
Krishna Gudipati 已提交
732 733 734 735
	case IOCPF_E_STOP:
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
		break;
736

K
Krishna Gudipati 已提交
737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
	default:
		bfa_sm_fault(ioc, event);
	}
}

/**
 * Request for semaphore.
 */
static void
bfa_iocpf_sm_semwait_entry(struct bfa_iocpf_s *iocpf)
{
	bfa_ioc_hw_sem_get(iocpf->ioc);
}

/**
 * Awaiting semaphore for h/w initialzation.
 */
static void
bfa_iocpf_sm_semwait(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
{
	struct bfa_ioc_s *ioc = iocpf->ioc;

	bfa_trc(ioc, event);

	switch (event) {
	case IOCPF_E_SEMLOCKED:
		iocpf->retry_count = 0;
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_hwinit);
765 766
		break;

K
Krishna Gudipati 已提交
767 768 769
	case IOCPF_E_DISABLE:
		bfa_ioc_hw_sem_get_cancel(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
770 771 772 773 774 775 776 777 778
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
K
Krishna Gudipati 已提交
779
bfa_iocpf_sm_hwinit_entry(struct bfa_iocpf_s *iocpf)
780
{
K
Krishna Gudipati 已提交
781 782
	bfa_iocpf_timer_start(iocpf->ioc);
	bfa_ioc_reset(iocpf->ioc, BFA_FALSE);
783 784 785
}

/**
K
Krishna Gudipati 已提交
786 787
 * Hardware is being initialized. Interrupts are enabled.
 * Holding hardware semaphore lock.
788 789
 */
static void
K
Krishna Gudipati 已提交
790
bfa_iocpf_sm_hwinit(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
791
{
K
Krishna Gudipati 已提交
792 793
	struct bfa_ioc_s *ioc = iocpf->ioc;

794 795 796
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
797 798 799
	case IOCPF_E_FWREADY:
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_enabling);
800 801
		break;

K
Krishna Gudipati 已提交
802 803
	case IOCPF_E_INITFAIL:
		bfa_iocpf_timer_stop(ioc);
804
		/*
K
Krishna Gudipati 已提交
805
		 * !!! fall through !!!
806 807
		 */

K
Krishna Gudipati 已提交
808 809 810 811 812
	case IOCPF_E_TIMEOUT:
		iocpf->retry_count++;
		if (iocpf->retry_count < BFA_IOC_HWINIT_MAX) {
			bfa_iocpf_timer_start(ioc);
			bfa_ioc_reset(ioc, BFA_TRUE);
813 814 815 816
			break;
		}

		bfa_ioc_hw_sem_release(ioc);
K
Krishna Gudipati 已提交
817
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);
818

K
Krishna Gudipati 已提交
819 820
		if (event == IOCPF_E_TIMEOUT)
			bfa_ioc_pf_failed(ioc);
821 822
		break;

K
Krishna Gudipati 已提交
823 824 825 826
	case IOCPF_E_DISABLE:
		bfa_ioc_hw_sem_release(ioc);
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
827 828 829 830 831 832 833 834 835
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
K
Krishna Gudipati 已提交
836
bfa_iocpf_sm_enabling_entry(struct bfa_iocpf_s *iocpf)
837
{
K
Krishna Gudipati 已提交
838 839
	bfa_iocpf_timer_start(iocpf->ioc);
	bfa_ioc_send_enable(iocpf->ioc);
840 841 842
}

/**
K
Krishna Gudipati 已提交
843 844
 * Host IOC function is being enabled, awaiting response from firmware.
 * Semaphore is acquired.
845 846
 */
static void
K
Krishna Gudipati 已提交
847
bfa_iocpf_sm_enabling(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
848
{
K
Krishna Gudipati 已提交
849 850
	struct bfa_ioc_s *ioc = iocpf->ioc;

851 852 853
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
854 855 856 857
	case IOCPF_E_FWRSP_ENABLE:
		bfa_iocpf_timer_stop(ioc);
		bfa_ioc_hw_sem_release(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_ready);
858 859
		break;

K
Krishna Gudipati 已提交
860 861
	case IOCPF_E_INITFAIL:
		bfa_iocpf_timer_stop(ioc);
862
		/*
K
Krishna Gudipati 已提交
863
		 * !!! fall through !!!
864 865
		 */

K
Krishna Gudipati 已提交
866 867 868 869 870 871 872 873 874 875 876 877 878 879
	case IOCPF_E_TIMEOUT:
		iocpf->retry_count++;
		if (iocpf->retry_count < BFA_IOC_HWINIT_MAX) {
			bfa_reg_write(ioc->ioc_regs.ioc_fwstate,
				      BFI_IOC_UNINIT);
			bfa_fsm_set_state(iocpf, bfa_iocpf_sm_hwinit);
			break;
		}

		bfa_ioc_hw_sem_release(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);

		if (event == IOCPF_E_TIMEOUT)
			bfa_ioc_pf_failed(ioc);
880 881
		break;

K
Krishna Gudipati 已提交
882 883 884 885 886 887 888 889
	case IOCPF_E_DISABLE:
		bfa_iocpf_timer_stop(ioc);
		bfa_ioc_hw_sem_release(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling);
		break;

	case IOCPF_E_FWREADY:
		bfa_ioc_send_enable(ioc);
890 891 892 893 894 895 896 897
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


K
Krishna Gudipati 已提交
898

899
static void
K
Krishna Gudipati 已提交
900
bfa_iocpf_sm_ready_entry(struct bfa_iocpf_s *iocpf)
901
{
K
Krishna Gudipati 已提交
902
	bfa_ioc_pf_enabled(iocpf->ioc);
903 904 905
}

static void
K
Krishna Gudipati 已提交
906
bfa_iocpf_sm_ready(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
907
{
K
Krishna Gudipati 已提交
908 909
	struct bfa_ioc_s *ioc = iocpf->ioc;

910 911 912
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
913 914 915 916 917 918
	case IOCPF_E_DISABLE:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabling);
		break;

	case IOCPF_E_GETATTRFAIL:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);
919 920
		break;

K
Krishna Gudipati 已提交
921 922
	case IOCPF_E_FAIL:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
923 924
		break;

K
Krishna Gudipati 已提交
925 926 927 928 929
	case IOCPF_E_FWREADY:
		if (bfa_ioc_is_operational(ioc))
			bfa_fsm_set_state(iocpf, bfa_iocpf_sm_fail);
		else
			bfa_fsm_set_state(iocpf, bfa_iocpf_sm_initfail);
930

K
Krishna Gudipati 已提交
931
		bfa_ioc_pf_failed(ioc);
932 933 934 935 936 937 938 939 940
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
K
Krishna Gudipati 已提交
941
bfa_iocpf_sm_disabling_entry(struct bfa_iocpf_s *iocpf)
942
{
K
Krishna Gudipati 已提交
943 944
	bfa_iocpf_timer_start(iocpf->ioc);
	bfa_ioc_send_disable(iocpf->ioc);
945 946 947 948 949 950
}

/**
 * IOC is being disabled
 */
static void
K
Krishna Gudipati 已提交
951
bfa_iocpf_sm_disabling(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
952
{
K
Krishna Gudipati 已提交
953 954
	struct bfa_ioc_s *ioc = iocpf->ioc;

955 956 957
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
958 959 960 961
	case IOCPF_E_FWRSP_DISABLE:
	case IOCPF_E_FWREADY:
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
962 963
		break;

K
Krishna Gudipati 已提交
964 965
	case IOCPF_E_FAIL:
		bfa_iocpf_timer_stop(ioc);
966 967 968 969
		/*
		 * !!! fall through !!!
		 */

K
Krishna Gudipati 已提交
970
	case IOCPF_E_TIMEOUT:
971
		bfa_reg_write(ioc->ioc_regs.ioc_fwstate, BFI_IOC_FAIL);
K
Krishna Gudipati 已提交
972 973 974 975
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
		break;

	case IOCPF_E_FWRSP_ENABLE:
976 977 978 979 980 981 982 983 984 985 986
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}

/**
 * IOC disable completion entry.
 */
static void
K
Krishna Gudipati 已提交
987
bfa_iocpf_sm_disabled_entry(struct bfa_iocpf_s *iocpf)
988
{
K
Krishna Gudipati 已提交
989
	bfa_ioc_pf_disabled(iocpf->ioc);
990 991 992
}

static void
K
Krishna Gudipati 已提交
993
bfa_iocpf_sm_disabled(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
994
{
K
Krishna Gudipati 已提交
995 996
	struct bfa_ioc_s *ioc = iocpf->ioc;

997 998 999
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
1000 1001
	case IOCPF_E_ENABLE:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_semwait);
1002 1003
		break;

K
Krishna Gudipati 已提交
1004
	case IOCPF_E_STOP:
1005
		bfa_ioc_firmware_unlock(ioc);
K
Krishna Gudipati 已提交
1006
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
1007 1008 1009 1010 1011 1012 1013 1014 1015
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
K
Krishna Gudipati 已提交
1016
bfa_iocpf_sm_initfail_entry(struct bfa_iocpf_s *iocpf)
1017
{
K
Krishna Gudipati 已提交
1018
	bfa_iocpf_timer_start(iocpf->ioc);
1019 1020 1021 1022 1023 1024
}

/**
 * Hardware initialization failed.
 */
static void
K
Krishna Gudipati 已提交
1025
bfa_iocpf_sm_initfail(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
1026
{
K
Krishna Gudipati 已提交
1027 1028
	struct bfa_ioc_s *ioc = iocpf->ioc;

1029 1030 1031
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
1032 1033 1034
	case IOCPF_E_DISABLE:
		bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
1035 1036
		break;

K
Krishna Gudipati 已提交
1037 1038
	case IOCPF_E_STOP:
		bfa_iocpf_timer_stop(ioc);
1039
		bfa_ioc_firmware_unlock(ioc);
K
Krishna Gudipati 已提交
1040
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_reset);
1041 1042
		break;

K
Krishna Gudipati 已提交
1043 1044
	case IOCPF_E_TIMEOUT:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_semwait);
1045 1046 1047 1048 1049 1050 1051 1052 1053
		break;

	default:
		bfa_sm_fault(ioc, event);
	}
}


static void
K
Krishna Gudipati 已提交
1054
bfa_iocpf_sm_fail_entry(struct bfa_iocpf_s *iocpf)
1055 1056 1057 1058
{
	/**
	 * Mark IOC as failed in hardware and stop firmware.
	 */
K
Krishna Gudipati 已提交
1059 1060
	bfa_ioc_lpu_stop(iocpf->ioc);
	bfa_reg_write(iocpf->ioc->ioc_regs.ioc_fwstate, BFI_IOC_FAIL);
1061

1062 1063 1064
	/**
	 * Notify other functions on HB failure.
	 */
K
Krishna Gudipati 已提交
1065
	bfa_ioc_notify_hbfail(iocpf->ioc);
1066 1067 1068 1069

	/**
	 * Flush any queued up mailbox requests.
	 */
K
Krishna Gudipati 已提交
1070
	bfa_ioc_mbox_hbfail(iocpf->ioc);
1071

K
Krishna Gudipati 已提交
1072 1073
	if (iocpf->auto_recover)
		bfa_iocpf_recovery_timer_start(iocpf->ioc);
1074 1075 1076
}

/**
K
Krishna Gudipati 已提交
1077
 * IOC is in failed state.
1078 1079
 */
static void
K
Krishna Gudipati 已提交
1080
bfa_iocpf_sm_fail(struct bfa_iocpf_s *iocpf, enum iocpf_event event)
1081
{
K
Krishna Gudipati 已提交
1082 1083
	struct bfa_ioc_s *ioc = iocpf->ioc;

1084 1085 1086
	bfa_trc(ioc, event);

	switch (event) {
K
Krishna Gudipati 已提交
1087 1088 1089 1090
	case IOCPF_E_DISABLE:
		if (iocpf->auto_recover)
			bfa_iocpf_timer_stop(ioc);
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_disabled);
1091 1092
		break;

K
Krishna Gudipati 已提交
1093 1094
	case IOCPF_E_TIMEOUT:
		bfa_fsm_set_state(iocpf, bfa_iocpf_sm_semwait);
1095 1096
		break;

1097 1098 1099 1100 1101 1102 1103 1104
	default:
		bfa_sm_fault(ioc, event);
	}
}



/**
K
Krishna Gudipati 已提交
1105
 *  hal_ioc_pvt BFA IOC private functions
1106 1107 1108 1109 1110
 */

static void
bfa_ioc_disable_comp(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1111 1112
	struct list_head			*qe;
	struct bfa_ioc_hbfail_notify_s	*notify;
1113 1114 1115 1116 1117 1118 1119

	ioc->cbfn->disable_cbfn(ioc->bfa);

	/**
	 * Notify common modules registered for notification.
	 */
	list_for_each(qe, &ioc->hb_notify_q) {
K
Krishna Gudipati 已提交
1120
		notify = (struct bfa_ioc_hbfail_notify_s *) qe;
1121 1122 1123 1124
		notify->cbfn(notify->cbarg);
	}
}

1125 1126
bfa_boolean_t
bfa_ioc_sem_get(bfa_os_addr_t sem_reg)
1127
{
1128 1129
	u32 r32;
	int cnt = 0;
K
Krishna Gudipati 已提交
1130
#define BFA_SEM_SPINCNT	3000
1131

1132 1133 1134
	r32 = bfa_reg_read(sem_reg);

	while (r32 && (cnt < BFA_SEM_SPINCNT)) {
1135
		cnt++;
1136
		udelay(2);
1137 1138 1139 1140 1141 1142
		r32 = bfa_reg_read(sem_reg);
	}

	if (r32 == 0)
		return BFA_TRUE;

1143
	bfa_assert(cnt < BFA_SEM_SPINCNT);
1144
	return BFA_FALSE;
1145 1146
}

1147 1148
void
bfa_ioc_sem_release(bfa_os_addr_t sem_reg)
1149
{
1150
	bfa_reg_write(sem_reg, 1);
1151 1152 1153 1154 1155
}

static void
bfa_ioc_hw_sem_get(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1156
	u32	r32;
1157 1158 1159

	/**
	 * First read to the semaphore register will return 0, subsequent reads
1160
	 * will return 1. Semaphore is released by writing 1 to the register
1161 1162 1163
	 */
	r32 = bfa_reg_read(ioc->ioc_regs.ioc_sem_reg);
	if (r32 == 0) {
K
Krishna Gudipati 已提交
1164
		bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_SEMLOCKED);
1165 1166 1167
		return;
	}

K
Krishna Gudipati 已提交
1168
	bfa_sem_timer_start(ioc);
1169 1170
}

1171
void
1172 1173 1174 1175 1176 1177 1178 1179
bfa_ioc_hw_sem_release(struct bfa_ioc_s *ioc)
{
	bfa_reg_write(ioc->ioc_regs.ioc_sem_reg, 1);
}

static void
bfa_ioc_hw_sem_get_cancel(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1180
	bfa_sem_timer_stop(ioc);
1181 1182 1183 1184 1185 1186 1187 1188
}

/**
 * Initialize LPU local memory (aka secondary memory / SRAM)
 */
static void
bfa_ioc_lmem_init(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1189 1190
	u32	pss_ctl;
	int		i;
1191 1192 1193 1194 1195
#define PSS_LMEM_INIT_TIME  10000

	pss_ctl = bfa_reg_read(ioc->ioc_regs.pss_ctl_reg);
	pss_ctl &= ~__PSS_LMEM_RESET;
	pss_ctl |= __PSS_LMEM_INIT_EN;
K
Krishna Gudipati 已提交
1196 1197 1198 1199 1200

	/*
	 * i2c workaround 12.5khz clock
	 */
	pss_ctl |= __PSS_I2C_CLK_DIV(3UL);
1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225
	bfa_reg_write(ioc->ioc_regs.pss_ctl_reg, pss_ctl);

	/**
	 * wait for memory initialization to be complete
	 */
	i = 0;
	do {
		pss_ctl = bfa_reg_read(ioc->ioc_regs.pss_ctl_reg);
		i++;
	} while (!(pss_ctl & __PSS_LMEM_INIT_DONE) && (i < PSS_LMEM_INIT_TIME));

	/**
	 * If memory initialization is not successful, IOC timeout will catch
	 * such failures.
	 */
	bfa_assert(pss_ctl & __PSS_LMEM_INIT_DONE);
	bfa_trc(ioc, pss_ctl);

	pss_ctl &= ~(__PSS_LMEM_INIT_DONE | __PSS_LMEM_INIT_EN);
	bfa_reg_write(ioc->ioc_regs.pss_ctl_reg, pss_ctl);
}

static void
bfa_ioc_lpu_start(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1226
	u32	pss_ctl;
1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239

	/**
	 * Take processor out of reset.
	 */
	pss_ctl = bfa_reg_read(ioc->ioc_regs.pss_ctl_reg);
	pss_ctl &= ~__PSS_LPU0_RESET;

	bfa_reg_write(ioc->ioc_regs.pss_ctl_reg, pss_ctl);
}

static void
bfa_ioc_lpu_stop(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1240
	u32	pss_ctl;
1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253

	/**
	 * Put processors in reset.
	 */
	pss_ctl = bfa_reg_read(ioc->ioc_regs.pss_ctl_reg);
	pss_ctl |= (__PSS_LPU0_RESET | __PSS_LPU1_RESET);

	bfa_reg_write(ioc->ioc_regs.pss_ctl_reg, pss_ctl);
}

/**
 * Get driver and firmware versions.
 */
1254
void
1255 1256
bfa_ioc_fwver_get(struct bfa_ioc_s *ioc, struct bfi_ioc_image_hdr_s *fwhdr)
{
K
Krishna Gudipati 已提交
1257 1258 1259 1260
	u32	pgnum, pgoff;
	u32	loff = 0;
	int		i;
	u32	*fwsig = (u32 *) fwhdr;
1261 1262 1263 1264 1265 1266 1267

	pgnum = bfa_ioc_smem_pgnum(ioc, loff);
	pgoff = bfa_ioc_smem_pgoff(ioc, loff);
	bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);

	for (i = 0; i < (sizeof(struct bfi_ioc_image_hdr_s) / sizeof(u32));
	     i++) {
K
Krishna Gudipati 已提交
1268 1269
		fwsig[i] =
			bfa_mem_read(ioc->ioc_regs.smem_page_start, loff);
1270 1271 1272 1273 1274 1275 1276
		loff += sizeof(u32);
	}
}

/**
 * Returns TRUE if same.
 */
1277
bfa_boolean_t
1278 1279 1280
bfa_ioc_fwver_cmp(struct bfa_ioc_s *ioc, struct bfi_ioc_image_hdr_s *fwhdr)
{
	struct bfi_ioc_image_hdr_s *drv_fwhdr;
K
Krishna Gudipati 已提交
1281
	int i;
1282

J
Jing Huang 已提交
1283
	drv_fwhdr = (struct bfi_ioc_image_hdr_s *)
K
Krishna Gudipati 已提交
1284
		bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), 0);
1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302

	for (i = 0; i < BFI_IOC_MD5SUM_SZ; i++) {
		if (fwhdr->md5sum[i] != drv_fwhdr->md5sum[i]) {
			bfa_trc(ioc, i);
			bfa_trc(ioc, fwhdr->md5sum[i]);
			bfa_trc(ioc, drv_fwhdr->md5sum[i]);
			return BFA_FALSE;
		}
	}

	bfa_trc(ioc, fwhdr->md5sum[0]);
	return BFA_TRUE;
}

/**
 * Return true if current running version is valid. Firmware signature and
 * execution context (driver/bios) must match.
 */
K
Krishna Gudipati 已提交
1303 1304
static bfa_boolean_t
bfa_ioc_fwver_valid(struct bfa_ioc_s *ioc, u32 boot_env)
1305 1306 1307 1308 1309 1310
{
	struct bfi_ioc_image_hdr_s fwhdr, *drv_fwhdr;

	/**
	 * If bios/efi boot (flash based) -- return true
	 */
K
Krishna Gudipati 已提交
1311
	if (bfa_ioc_is_bios_optrom(ioc))
1312 1313 1314
		return BFA_TRUE;

	bfa_ioc_fwver_get(ioc, &fwhdr);
J
Jing Huang 已提交
1315
	drv_fwhdr = (struct bfi_ioc_image_hdr_s *)
K
Krishna Gudipati 已提交
1316
		bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), 0);
1317 1318 1319 1320 1321 1322 1323

	if (fwhdr.signature != drv_fwhdr->signature) {
		bfa_trc(ioc, fwhdr.signature);
		bfa_trc(ioc, drv_fwhdr->signature);
		return BFA_FALSE;
	}

K
Krishna Gudipati 已提交
1324 1325 1326
	if (bfa_os_swap32(fwhdr.param) != boot_env) {
		bfa_trc(ioc, fwhdr.param);
		bfa_trc(ioc, boot_env);
1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338
		return BFA_FALSE;
	}

	return bfa_ioc_fwver_cmp(ioc, &fwhdr);
}

/**
 * Conditionally flush any pending message from firmware at start.
 */
static void
bfa_ioc_msgflush(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1339
	u32	r32;
1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350

	r32 = bfa_reg_read(ioc->ioc_regs.lpu_mbox_cmd);
	if (r32)
		bfa_reg_write(ioc->ioc_regs.lpu_mbox_cmd, 1);
}


static void
bfa_ioc_hwinit(struct bfa_ioc_s *ioc, bfa_boolean_t force)
{
	enum bfi_ioc_state ioc_fwstate;
K
Krishna Gudipati 已提交
1351 1352 1353
	bfa_boolean_t fwvalid;
	u32 boot_type;
	u32 boot_env;
1354 1355 1356 1357 1358 1359 1360 1361

	ioc_fwstate = bfa_reg_read(ioc->ioc_regs.ioc_fwstate);

	if (force)
		ioc_fwstate = BFI_IOC_UNINIT;

	bfa_trc(ioc, ioc_fwstate);

K
Krishna Gudipati 已提交
1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
	boot_type = BFI_BOOT_TYPE_NORMAL;
	boot_env = BFI_BOOT_LOADER_OS;

	/**
	 * Flash based firmware boot BIOS env.
	 */
	if (bfa_ioc_is_bios_optrom(ioc)) {
		boot_type = BFI_BOOT_TYPE_FLASH;
		boot_env = BFI_BOOT_LOADER_BIOS;
	}

	/**
	 * Flash based firmware boot UEFI env.
	 */
	if (bfa_ioc_is_uefi(ioc)) {
		boot_type = BFI_BOOT_TYPE_FLASH;
		boot_env = BFI_BOOT_LOADER_UEFI;
	}

1381 1382 1383 1384
	/**
	 * check if firmware is valid
	 */
	fwvalid = (ioc_fwstate == BFI_IOC_UNINIT) ?
K
Krishna Gudipati 已提交
1385
		BFA_FALSE : bfa_ioc_fwver_valid(ioc, boot_env);
1386 1387

	if (!fwvalid) {
K
Krishna Gudipati 已提交
1388
		bfa_ioc_boot(ioc, boot_type, boot_env);
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403
		return;
	}

	/**
	 * If hardware initialization is in progress (initialized by other IOC),
	 * just wait for an initialization completion interrupt.
	 */
	if (ioc_fwstate == BFI_IOC_INITING) {
		ioc->cbfn->reset_cbfn(ioc->bfa);
		return;
	}

	/**
	 * If IOC function is disabled and firmware version is same,
	 * just re-enable IOC.
J
Jing Huang 已提交
1404 1405 1406 1407
	 *
	 * If option rom, IOC must not be in operational state. With
	 * convergence, IOC will be in operational state when 2nd driver
	 * is loaded.
1408
	 */
J
Jing Huang 已提交
1409
	if (ioc_fwstate == BFI_IOC_DISABLED ||
K
Krishna Gudipati 已提交
1410
	    (!bfa_ioc_is_bios_optrom(ioc) && ioc_fwstate == BFI_IOC_OP)) {
1411 1412 1413 1414 1415 1416 1417

		/**
		 * When using MSI-X any pending firmware ready event should
		 * be flushed. Otherwise MSI-X interrupts are not delivered.
		 */
		bfa_ioc_msgflush(ioc);
		ioc->cbfn->reset_cbfn(ioc->bfa);
K
Krishna Gudipati 已提交
1418
		bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FWREADY);
1419 1420 1421 1422 1423 1424
		return;
	}

	/**
	 * Initialize the h/w for any other states.
	 */
K
Krishna Gudipati 已提交
1425
	bfa_ioc_boot(ioc, boot_type, boot_env);
1426 1427 1428 1429 1430
}

static void
bfa_ioc_timeout(void *ioc_arg)
{
K
Krishna Gudipati 已提交
1431
	struct bfa_ioc_s  *ioc = (struct bfa_ioc_s *) ioc_arg;
1432 1433 1434 1435 1436 1437 1438 1439

	bfa_trc(ioc, 0);
	bfa_fsm_send_event(ioc, IOC_E_TIMEOUT);
}

void
bfa_ioc_mbox_send(struct bfa_ioc_s *ioc, void *ioc_msg, int len)
{
K
Krishna Gudipati 已提交
1440 1441
	u32 *msgp = (u32 *) ioc_msg;
	u32 i;
1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461

	bfa_trc(ioc, msgp[0]);
	bfa_trc(ioc, len);

	bfa_assert(len <= BFI_IOC_MSGLEN_MAX);

	/*
	 * first write msg to mailbox registers
	 */
	for (i = 0; i < len / sizeof(u32); i++)
		bfa_reg_write(ioc->ioc_regs.hfn_mbox + i * sizeof(u32),
			      bfa_os_wtole(msgp[i]));

	for (; i < BFI_IOC_MSGLEN_MAX / sizeof(u32); i++)
		bfa_reg_write(ioc->ioc_regs.hfn_mbox + i * sizeof(u32), 0);

	/*
	 * write 1 to mailbox CMD to trigger LPU event
	 */
	bfa_reg_write(ioc->ioc_regs.hfn_mbox_cmd, 1);
K
Krishna Gudipati 已提交
1462
	(void) bfa_reg_read(ioc->ioc_regs.hfn_mbox_cmd);
1463 1464 1465 1466 1467 1468
}

static void
bfa_ioc_send_enable(struct bfa_ioc_s *ioc)
{
	struct bfi_ioc_ctrl_req_s enable_req;
K
Krishna Gudipati 已提交
1469
	struct bfa_timeval_s tv;
1470 1471 1472 1473

	bfi_h2i_set(enable_req.mh, BFI_MC_IOC, BFI_IOC_H2I_ENABLE_REQ,
		    bfa_ioc_portid(ioc));
	enable_req.ioc_class = ioc->ioc_mc;
K
Krishna Gudipati 已提交
1474 1475
	bfa_os_gettimeofday(&tv);
	enable_req.tv_sec = bfa_os_ntohl(tv.tv_sec);
1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491
	bfa_ioc_mbox_send(ioc, &enable_req, sizeof(struct bfi_ioc_ctrl_req_s));
}

static void
bfa_ioc_send_disable(struct bfa_ioc_s *ioc)
{
	struct bfi_ioc_ctrl_req_s disable_req;

	bfi_h2i_set(disable_req.mh, BFI_MC_IOC, BFI_IOC_H2I_DISABLE_REQ,
		    bfa_ioc_portid(ioc));
	bfa_ioc_mbox_send(ioc, &disable_req, sizeof(struct bfi_ioc_ctrl_req_s));
}

static void
bfa_ioc_send_getattr(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1492
	struct bfi_ioc_getattr_req_s	attr_req;
1493 1494 1495 1496 1497 1498 1499 1500 1501 1502

	bfi_h2i_set(attr_req.mh, BFI_MC_IOC, BFI_IOC_H2I_GETATTR_REQ,
		    bfa_ioc_portid(ioc));
	bfa_dma_be_addr_set(attr_req.attr_addr, ioc->attr_dma.pa);
	bfa_ioc_mbox_send(ioc, &attr_req, sizeof(attr_req));
}

static void
bfa_ioc_hb_check(void *cbarg)
{
1503
	struct bfa_ioc_s  *ioc = cbarg;
K
Krishna Gudipati 已提交
1504
	u32	hb_count;
1505 1506 1507

	hb_count = bfa_reg_read(ioc->ioc_regs.heartbeat);
	if (ioc->hb_count == hb_count) {
K
Krishna Gudipati 已提交
1508
		printk(KERN_CRIT "Firmware heartbeat failure at %d", hb_count);
1509 1510
		bfa_ioc_recover(ioc);
		return;
1511 1512
	} else {
		ioc->hb_count = hb_count;
1513 1514 1515
	}

	bfa_ioc_mbox_poll(ioc);
K
Krishna Gudipati 已提交
1516
	bfa_hb_timer_start(ioc);
1517 1518 1519 1520 1521 1522
}

static void
bfa_ioc_hb_monitor(struct bfa_ioc_s *ioc)
{
	ioc->hb_count = bfa_reg_read(ioc->ioc_regs.heartbeat);
K
Krishna Gudipati 已提交
1523
	bfa_hb_timer_start(ioc);
1524 1525 1526 1527 1528
}

static void
bfa_ioc_hb_stop(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
1529
	bfa_hb_timer_stop(ioc);
1530 1531
}

K
Krishna Gudipati 已提交
1532

1533
/**
K
Krishna Gudipati 已提交
1534
 *	Initiate a full firmware download.
1535 1536 1537
 */
static void
bfa_ioc_download_fw(struct bfa_ioc_s *ioc, u32 boot_type,
K
Krishna Gudipati 已提交
1538
		    u32 boot_env)
1539
{
K
Krishna Gudipati 已提交
1540 1541 1542 1543 1544
	u32 *fwimg;
	u32 pgnum, pgoff;
	u32 loff = 0;
	u32 chunkno = 0;
	u32 i;
1545 1546 1547 1548 1549 1550

	/**
	 * Initialize LMEM first before code download
	 */
	bfa_ioc_lmem_init(ioc);

K
Krishna Gudipati 已提交
1551 1552
	bfa_trc(ioc, bfa_cb_image_get_size(BFA_IOC_FWIMG_TYPE(ioc)));
	fwimg = bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc), chunkno);
1553 1554 1555 1556 1557 1558

	pgnum = bfa_ioc_smem_pgnum(ioc, loff);
	pgoff = bfa_ioc_smem_pgoff(ioc, loff);

	bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);

K
Krishna Gudipati 已提交
1559
	for (i = 0; i < bfa_cb_image_get_size(BFA_IOC_FWIMG_TYPE(ioc)); i++) {
1560

1561 1562
		if (BFA_IOC_FLASH_CHUNK_NO(i) != chunkno) {
			chunkno = BFA_IOC_FLASH_CHUNK_NO(i);
K
Krishna Gudipati 已提交
1563
			fwimg = bfa_cb_image_get_chunk(BFA_IOC_FWIMG_TYPE(ioc),
1564
					BFA_IOC_FLASH_CHUNK_ADDR(chunkno));
1565 1566 1567 1568 1569 1570
		}

		/**
		 * write smem
		 */
		bfa_mem_write(ioc->ioc_regs.smem_page_start, loff,
1571
			      fwimg[BFA_IOC_FLASH_OFFSET_IN_CHUNK(i)]);
1572 1573 1574 1575 1576 1577 1578 1579 1580

		loff += sizeof(u32);

		/**
		 * handle page offset wrap around
		 */
		loff = PSS_SMEM_PGOFF(loff);
		if (loff == 0) {
			pgnum++;
K
Krishna Gudipati 已提交
1581 1582
			bfa_reg_write(ioc->ioc_regs.host_page_num_fn,
				      pgnum);
1583 1584 1585 1586 1587
		}
	}

	bfa_reg_write(ioc->ioc_regs.host_page_num_fn,
		      bfa_ioc_smem_pgnum(ioc, 0));
1588 1589 1590

	/*
	 * Set boot type and boot param at the end.
K
Krishna Gudipati 已提交
1591
	*/
1592 1593
	bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_BOOT_TYPE_OFF,
			bfa_os_swap32(boot_type));
K
Krishna Gudipati 已提交
1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786 1787 1788
	bfa_mem_write(ioc->ioc_regs.smem_page_start, BFI_BOOT_LOADER_OFF,
			bfa_os_swap32(boot_env));
}

static void
bfa_ioc_reset(struct bfa_ioc_s *ioc, bfa_boolean_t force)
{
	bfa_ioc_hwinit(ioc, force);
}

/**
 * Update BFA configuration from firmware configuration.
 */
static void
bfa_ioc_getattr_reply(struct bfa_ioc_s *ioc)
{
	struct bfi_ioc_attr_s	*attr = ioc->attr;

	attr->adapter_prop  = bfa_os_ntohl(attr->adapter_prop);
	attr->card_type     = bfa_os_ntohl(attr->card_type);
	attr->maxfrsize	    = bfa_os_ntohs(attr->maxfrsize);

	bfa_fsm_send_event(ioc, IOC_E_FWRSP_GETATTR);
}

/**
 * Attach time initialization of mbox logic.
 */
static void
bfa_ioc_mbox_attach(struct bfa_ioc_s *ioc)
{
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	int	mc;

	INIT_LIST_HEAD(&mod->cmd_q);
	for (mc = 0; mc < BFI_MC_MAX; mc++) {
		mod->mbhdlr[mc].cbfn = NULL;
		mod->mbhdlr[mc].cbarg = ioc->bfa;
	}
}

/**
 * Mbox poll timer -- restarts any pending mailbox requests.
 */
static void
bfa_ioc_mbox_poll(struct bfa_ioc_s *ioc)
{
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	struct bfa_mbox_cmd_s		*cmd;
	u32			stat;

	/**
	 * If no command pending, do nothing
	 */
	if (list_empty(&mod->cmd_q))
		return;

	/**
	 * If previous command is not yet fetched by firmware, do nothing
	 */
	stat = bfa_reg_read(ioc->ioc_regs.hfn_mbox_cmd);
	if (stat)
		return;

	/**
	 * Enqueue command to firmware.
	 */
	bfa_q_deq(&mod->cmd_q, &cmd);
	bfa_ioc_mbox_send(ioc, cmd->msg, sizeof(cmd->msg));
}

/**
 * Cleanup any pending requests.
 */
static void
bfa_ioc_mbox_hbfail(struct bfa_ioc_s *ioc)
{
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	struct bfa_mbox_cmd_s		*cmd;

	while (!list_empty(&mod->cmd_q))
		bfa_q_deq(&mod->cmd_q, &cmd);
}

/**
 * Read data from SMEM to host through PCI memmap
 *
 * @param[in]	ioc	memory for IOC
 * @param[in]	tbuf	app memory to store data from smem
 * @param[in]	soff	smem offset
 * @param[in]	sz	size of smem in bytes
 */
static bfa_status_t
bfa_ioc_smem_read(struct bfa_ioc_s *ioc, void *tbuf, u32 soff, u32 sz)
{
	u32 pgnum, loff, r32;
	int i, len;
	u32 *buf = tbuf;

	pgnum = bfa_ioc_smem_pgnum(ioc, soff);
	loff = bfa_ioc_smem_pgoff(ioc, soff);
	bfa_trc(ioc, pgnum);
	bfa_trc(ioc, loff);
	bfa_trc(ioc, sz);

	/*
	 *  Hold semaphore to serialize pll init and fwtrc.
	 */
	if (BFA_FALSE == bfa_ioc_sem_get(ioc->ioc_regs.ioc_init_sem_reg)) {
		bfa_trc(ioc, 0);
		return BFA_STATUS_FAILED;
	}

	bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);

	len = sz/sizeof(u32);
	bfa_trc(ioc, len);
	for (i = 0; i < len; i++) {
		r32 = bfa_mem_read(ioc->ioc_regs.smem_page_start, loff);
		buf[i] = bfa_os_ntohl(r32);
		loff += sizeof(u32);

		/**
		 * handle page offset wrap around
		 */
		loff = PSS_SMEM_PGOFF(loff);
		if (loff == 0) {
			pgnum++;
			bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);
		}
	}
	bfa_reg_write(ioc->ioc_regs.host_page_num_fn,
		      bfa_ioc_smem_pgnum(ioc, 0));
	/*
	 *  release semaphore.
	 */
	bfa_ioc_sem_release(ioc->ioc_regs.ioc_init_sem_reg);

	bfa_trc(ioc, pgnum);
	return BFA_STATUS_OK;
}

/**
 * Clear SMEM data from host through PCI memmap
 *
 * @param[in]	ioc	memory for IOC
 * @param[in]	soff	smem offset
 * @param[in]	sz	size of smem in bytes
 */
static bfa_status_t
bfa_ioc_smem_clr(struct bfa_ioc_s *ioc, u32 soff, u32 sz)
{
	int i, len;
	u32 pgnum, loff;

	pgnum = bfa_ioc_smem_pgnum(ioc, soff);
	loff = bfa_ioc_smem_pgoff(ioc, soff);
	bfa_trc(ioc, pgnum);
	bfa_trc(ioc, loff);
	bfa_trc(ioc, sz);

	/*
	 *  Hold semaphore to serialize pll init and fwtrc.
	 */
	if (BFA_FALSE == bfa_ioc_sem_get(ioc->ioc_regs.ioc_init_sem_reg)) {
		bfa_trc(ioc, 0);
		return BFA_STATUS_FAILED;
	}

	bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);

	len = sz/sizeof(u32); /* len in words */
	bfa_trc(ioc, len);
	for (i = 0; i < len; i++) {
		bfa_mem_write(ioc->ioc_regs.smem_page_start, loff, 0);
		loff += sizeof(u32);

		/**
		 * handle page offset wrap around
		 */
		loff = PSS_SMEM_PGOFF(loff);
		if (loff == 0) {
			pgnum++;
			bfa_reg_write(ioc->ioc_regs.host_page_num_fn, pgnum);
		}
	}
	bfa_reg_write(ioc->ioc_regs.host_page_num_fn,
		      bfa_ioc_smem_pgnum(ioc, 0));

	/*
	 *  release semaphore.
	 */
	bfa_ioc_sem_release(ioc->ioc_regs.ioc_init_sem_reg);
	bfa_trc(ioc, pgnum);
	return BFA_STATUS_OK;
1789 1790
}

K
Krishna Gudipati 已提交
1791 1792 1793
/**
 * hal iocpf to ioc interface
 */
1794
static void
K
Krishna Gudipati 已提交
1795
bfa_ioc_pf_enabled(struct bfa_ioc_s *ioc)
1796
{
K
Krishna Gudipati 已提交
1797
	bfa_fsm_send_event(ioc, IOC_E_ENABLED);
1798 1799 1800
}

static void
K
Krishna Gudipati 已提交
1801
bfa_ioc_pf_disabled(struct bfa_ioc_s *ioc)
1802
{
K
Krishna Gudipati 已提交
1803
	bfa_fsm_send_event(ioc, IOC_E_DISABLED);
1804 1805 1806
}

static void
K
Krishna Gudipati 已提交
1807
bfa_ioc_pf_failed(struct bfa_ioc_s *ioc)
1808
{
K
Krishna Gudipati 已提交
1809
	bfa_fsm_send_event(ioc, IOC_E_FAILED);
1810 1811 1812
}

static void
K
Krishna Gudipati 已提交
1813
bfa_ioc_pf_fwmismatch(struct bfa_ioc_s *ioc)
1814
{
K
Krishna Gudipati 已提交
1815
	struct bfad_s *bfad = (struct bfad_s *)ioc->bfa->bfad;
1816
	/**
K
Krishna Gudipati 已提交
1817
	 * Provide enable completion callback.
1818
	 */
K
Krishna Gudipati 已提交
1819 1820 1821 1822 1823
	ioc->cbfn->enable_cbfn(ioc->bfa, BFA_STATUS_IOC_FAILURE);
	BFA_LOG(KERN_WARNING, bfad, log_level,
		"Running firmware version is incompatible "
		"with the driver version\n");
}
1824 1825 1826 1827



/**
K
Krishna Gudipati 已提交
1828
 *  hal_ioc_public
1829
 */
K
Krishna Gudipati 已提交
1830 1831 1832

bfa_status_t
bfa_ioc_pll_init(struct bfa_ioc_s *ioc)
1833 1834
{

K
Krishna Gudipati 已提交
1835 1836 1837 1838
	/*
	 *  Hold semaphore so that nobody can access the chip during init.
	 */
	bfa_ioc_sem_get(ioc->ioc_regs.ioc_init_sem_reg);
1839

K
Krishna Gudipati 已提交
1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
	bfa_ioc_pll_init_asic(ioc);

	ioc->pllinit = BFA_TRUE;
	/*
	 *  release semaphore.
	 */
	bfa_ioc_sem_release(ioc->ioc_regs.ioc_init_sem_reg);

	return BFA_STATUS_OK;
}
1850 1851 1852 1853 1854 1855

/**
 * Interface used by diag module to do firmware boot with memory test
 * as the entry vector.
 */
void
K
Krishna Gudipati 已提交
1856
bfa_ioc_boot(struct bfa_ioc_s *ioc, u32 boot_type, u32 boot_env)
1857
{
K
Krishna Gudipati 已提交
1858
	bfa_os_addr_t	rb;
1859 1860 1861 1862 1863 1864 1865 1866 1867 1868

	bfa_ioc_stats(ioc, ioc_boots);

	if (bfa_ioc_pll_init(ioc) != BFA_STATUS_OK)
		return;

	/**
	 * Initialize IOC state of all functions on a chip reset.
	 */
	rb = ioc->pcidev.pci_bar_kva;
K
Krishna Gudipati 已提交
1869
	if (boot_type == BFI_BOOT_TYPE_MEMTEST) {
1870 1871 1872 1873 1874 1875 1876
		bfa_reg_write((rb + BFA_IOC0_STATE_REG), BFI_IOC_MEMTEST);
		bfa_reg_write((rb + BFA_IOC1_STATE_REG), BFI_IOC_MEMTEST);
	} else {
		bfa_reg_write((rb + BFA_IOC0_STATE_REG), BFI_IOC_INITING);
		bfa_reg_write((rb + BFA_IOC1_STATE_REG), BFI_IOC_INITING);
	}

J
Jing Huang 已提交
1877
	bfa_ioc_msgflush(ioc);
K
Krishna Gudipati 已提交
1878
	bfa_ioc_download_fw(ioc, boot_type, boot_env);
1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892

	/**
	 * Enable interrupts just before starting LPU
	 */
	ioc->cbfn->reset_cbfn(ioc->bfa);
	bfa_ioc_lpu_start(ioc);
}

/**
 * Enable/disable IOC failure auto recovery.
 */
void
bfa_ioc_auto_recover(bfa_boolean_t auto_recover)
{
1893
	bfa_auto_recover = auto_recover;
1894 1895 1896
}


K
Krishna Gudipati 已提交
1897

1898 1899 1900 1901 1902 1903
bfa_boolean_t
bfa_ioc_is_operational(struct bfa_ioc_s *ioc)
{
	return bfa_fsm_cmp_state(ioc, bfa_ioc_sm_op);
}

K
Krishna Gudipati 已提交
1904 1905 1906 1907 1908 1909 1910 1911 1912 1913
bfa_boolean_t
bfa_ioc_is_initialized(struct bfa_ioc_s *ioc)
{
	u32 r32 = bfa_reg_read(ioc->ioc_regs.ioc_fwstate);

	return ((r32 != BFI_IOC_UNINIT) &&
		(r32 != BFI_IOC_INITING) &&
		(r32 != BFI_IOC_MEMTEST));
}

1914 1915 1916
void
bfa_ioc_msgget(struct bfa_ioc_s *ioc, void *mbmsg)
{
K
Krishna Gudipati 已提交
1917 1918 1919
	u32	*msgp = mbmsg;
	u32	r32;
	int		i;
1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940

	/**
	 * read the MBOX msg
	 */
	for (i = 0; i < (sizeof(union bfi_ioc_i2h_msg_u) / sizeof(u32));
	     i++) {
		r32 = bfa_reg_read(ioc->ioc_regs.lpu_mbox +
				   i * sizeof(u32));
		msgp[i] = bfa_os_htonl(r32);
	}

	/**
	 * turn off mailbox interrupt by clearing mailbox status
	 */
	bfa_reg_write(ioc->ioc_regs.lpu_mbox_cmd, 1);
	bfa_reg_read(ioc->ioc_regs.lpu_mbox_cmd);
}

void
bfa_ioc_isr(struct bfa_ioc_s *ioc, struct bfi_mbmsg_s *m)
{
K
Krishna Gudipati 已提交
1941 1942
	union bfi_ioc_i2h_msg_u	*msg;
	struct bfa_iocpf_s *iocpf = &ioc->iocpf;
1943

K
Krishna Gudipati 已提交
1944
	msg = (union bfi_ioc_i2h_msg_u *) m;
1945 1946 1947 1948 1949 1950 1951 1952

	bfa_ioc_stats(ioc, ioc_isrs);

	switch (msg->mh.msg_id) {
	case BFI_IOC_I2H_HBEAT:
		break;

	case BFI_IOC_I2H_READY_EVENT:
K
Krishna Gudipati 已提交
1953
		bfa_fsm_send_event(iocpf, IOCPF_E_FWREADY);
1954 1955 1956
		break;

	case BFI_IOC_I2H_ENABLE_REPLY:
K
Krishna Gudipati 已提交
1957
		bfa_fsm_send_event(iocpf, IOCPF_E_FWRSP_ENABLE);
1958 1959 1960
		break;

	case BFI_IOC_I2H_DISABLE_REPLY:
K
Krishna Gudipati 已提交
1961
		bfa_fsm_send_event(iocpf, IOCPF_E_FWRSP_DISABLE);
1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981
		break;

	case BFI_IOC_I2H_GETATTR_REPLY:
		bfa_ioc_getattr_reply(ioc);
		break;

	default:
		bfa_trc(ioc, msg->mh.msg_id);
		bfa_assert(0);
	}
}

/**
 * IOC attach time initialization and setup.
 *
 * @param[in]	ioc	memory for IOC
 * @param[in]	bfa	driver instance structure
 */
void
bfa_ioc_attach(struct bfa_ioc_s *ioc, void *bfa, struct bfa_ioc_cbfn_s *cbfn,
K
Krishna Gudipati 已提交
1982 1983 1984 1985 1986 1987 1988
	       struct bfa_timer_mod_s *timer_mod)
{
	ioc->bfa	= bfa;
	ioc->cbfn	= cbfn;
	ioc->timer_mod	= timer_mod;
	ioc->fcmode	= BFA_FALSE;
	ioc->pllinit	= BFA_FALSE;
1989
	ioc->dbg_fwsave_once = BFA_TRUE;
K
Krishna Gudipati 已提交
1990
	ioc->iocpf.ioc	= ioc;
1991 1992 1993 1994

	bfa_ioc_mbox_attach(ioc);
	INIT_LIST_HEAD(&ioc->hb_notify_q);

K
Krishna Gudipati 已提交
1995 1996
	bfa_fsm_set_state(ioc, bfa_ioc_sm_uninit);
	bfa_fsm_send_event(ioc, IOC_E_RESET);
1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016
}

/**
 * Driver detach time IOC cleanup.
 */
void
bfa_ioc_detach(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(ioc, IOC_E_DETACH);
}

/**
 * Setup IOC PCI properties.
 *
 * @param[in]	pcidev	PCI device information for this IOC
 */
void
bfa_ioc_pci_init(struct bfa_ioc_s *ioc, struct bfa_pcidev_s *pcidev,
		 enum bfi_mclass mc)
{
K
Krishna Gudipati 已提交
2017 2018 2019 2020
	ioc->ioc_mc	= mc;
	ioc->pcidev	= *pcidev;
	ioc->ctdev	= bfa_asic_id_ct(ioc->pcidev.device_id);
	ioc->cna	= ioc->ctdev && !ioc->fcmode;
2021

2022 2023 2024 2025 2026 2027 2028 2029
	/**
	 * Set asic specific interfaces. See bfa_ioc_cb.c and bfa_ioc_ct.c
	 */
	if (ioc->ctdev)
		bfa_ioc_set_ct_hwif(ioc);
	else
		bfa_ioc_set_cb_hwif(ioc);

2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040
	bfa_ioc_map_port(ioc);
	bfa_ioc_reg_init(ioc);
}

/**
 * Initialize IOC dma memory
 *
 * @param[in]	dm_kva	kernel virtual address of IOC dma memory
 * @param[in]	dm_pa	physical address of IOC dma memory
 */
void
K
Krishna Gudipati 已提交
2041
bfa_ioc_mem_claim(struct bfa_ioc_s *ioc,  u8 *dm_kva, u64 dm_pa)
2042 2043 2044 2045 2046 2047
{
	/**
	 * dma memory for firmware attribute
	 */
	ioc->attr_dma.kva = dm_kva;
	ioc->attr_dma.pa = dm_pa;
K
Krishna Gudipati 已提交
2048
	ioc->attr = (struct bfi_ioc_attr_s *) dm_kva;
2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085
}

/**
 * Return size of dma memory required.
 */
u32
bfa_ioc_meminfo(void)
{
	return BFA_ROUNDUP(sizeof(struct bfi_ioc_attr_s), BFA_DMA_ALIGN_SZ);
}

void
bfa_ioc_enable(struct bfa_ioc_s *ioc)
{
	bfa_ioc_stats(ioc, ioc_enables);
	ioc->dbg_fwsave_once = BFA_TRUE;

	bfa_fsm_send_event(ioc, IOC_E_ENABLE);
}

void
bfa_ioc_disable(struct bfa_ioc_s *ioc)
{
	bfa_ioc_stats(ioc, ioc_disables);
	bfa_fsm_send_event(ioc, IOC_E_DISABLE);
}

/**
 * Returns memory required for saving firmware trace in case of crash.
 * Driver must call this interface to allocate memory required for
 * automatic saving of firmware trace. Driver should call
 * bfa_ioc_debug_memclaim() right after bfa_ioc_attach() to setup this
 * trace memory.
 */
int
bfa_ioc_debug_trcsz(bfa_boolean_t auto_recover)
{
K
Krishna Gudipati 已提交
2086
	return (auto_recover) ? BFA_DBG_FWTRC_LEN : 0;
2087 2088 2089 2090 2091 2092 2093 2094 2095
}

/**
 * Initialize memory for saving firmware trace. Driver must initialize
 * trace memory before call bfa_ioc_enable().
 */
void
bfa_ioc_debug_memclaim(struct bfa_ioc_s *ioc, void *dbg_fwsave)
{
K
Krishna Gudipati 已提交
2096 2097
	ioc->dbg_fwsave	    = dbg_fwsave;
	ioc->dbg_fwsave_len = bfa_ioc_debug_trcsz(ioc->iocpf.auto_recover);
2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120
}

u32
bfa_ioc_smem_pgnum(struct bfa_ioc_s *ioc, u32 fmaddr)
{
	return PSS_SMEM_PGNUM(ioc->ioc_regs.smem_pg0, fmaddr);
}

u32
bfa_ioc_smem_pgoff(struct bfa_ioc_s *ioc, u32 fmaddr)
{
	return PSS_SMEM_PGOFF(fmaddr);
}

/**
 * Register mailbox message handler functions
 *
 * @param[in]	ioc		IOC instance
 * @param[in]	mcfuncs		message class handler functions
 */
void
bfa_ioc_mbox_register(struct bfa_ioc_s *ioc, bfa_ioc_mbox_mcfunc_t *mcfuncs)
{
K
Krishna Gudipati 已提交
2121 2122
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	int				mc;
2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134

	for (mc = 0; mc < BFI_MC_MAX; mc++)
		mod->mbhdlr[mc].cbfn = mcfuncs[mc];
}

/**
 * Register mailbox message handler function, to be called by common modules
 */
void
bfa_ioc_mbox_regisr(struct bfa_ioc_s *ioc, enum bfi_mclass mc,
		    bfa_ioc_mbox_mcfunc_t cbfn, void *cbarg)
{
K
Krishna Gudipati 已提交
2135
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
2136

K
Krishna Gudipati 已提交
2137 2138
	mod->mbhdlr[mc].cbfn	= cbfn;
	mod->mbhdlr[mc].cbarg	= cbarg;
2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
}

/**
 * Queue a mailbox command request to firmware. Waits if mailbox is busy.
 * Responsibility of caller to serialize
 *
 * @param[in]	ioc	IOC instance
 * @param[i]	cmd	Mailbox command
 */
void
bfa_ioc_mbox_queue(struct bfa_ioc_s *ioc, struct bfa_mbox_cmd_s *cmd)
{
K
Krishna Gudipati 已提交
2151 2152
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	u32			stat;
2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179 2180 2181 2182

	/**
	 * If a previous command is pending, queue new command
	 */
	if (!list_empty(&mod->cmd_q)) {
		list_add_tail(&cmd->qe, &mod->cmd_q);
		return;
	}

	/**
	 * If mailbox is busy, queue command for poll timer
	 */
	stat = bfa_reg_read(ioc->ioc_regs.hfn_mbox_cmd);
	if (stat) {
		list_add_tail(&cmd->qe, &mod->cmd_q);
		return;
	}

	/**
	 * mailbox is free -- queue command to firmware
	 */
	bfa_ioc_mbox_send(ioc, cmd->msg, sizeof(cmd->msg));
}

/**
 * Handle mailbox interrupts
 */
void
bfa_ioc_mbox_isr(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2183 2184 2185
	struct bfa_ioc_mbox_mod_s	*mod = &ioc->mbox_mod;
	struct bfi_mbmsg_s		m;
	int				mc;
2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209

	bfa_ioc_msgget(ioc, &m);

	/**
	 * Treat IOC message class as special.
	 */
	mc = m.mh.msg_class;
	if (mc == BFI_MC_IOC) {
		bfa_ioc_isr(ioc, &m);
		return;
	}

	if ((mc > BFI_MC_MAX) || (mod->mbhdlr[mc].cbfn == NULL))
		return;

	mod->mbhdlr[mc].cbfn(mod->mbhdlr[mc].cbarg, &m);
}

void
bfa_ioc_error_isr(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(ioc, IOC_E_HWERROR);
}

2210 2211 2212 2213 2214 2215 2216
void
bfa_ioc_set_fcmode(struct bfa_ioc_s *ioc)
{
	ioc->fcmode  = BFA_TRUE;
	ioc->port_id = bfa_ioc_pcifn(ioc);
}

2217 2218 2219 2220 2221 2222
/**
 * return true if IOC is disabled
 */
bfa_boolean_t
bfa_ioc_is_disabled(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2223 2224
	return bfa_fsm_cmp_state(ioc, bfa_ioc_sm_disabling) ||
		bfa_fsm_cmp_state(ioc, bfa_ioc_sm_disabled);
2225 2226 2227 2228 2229 2230 2231 2232
}

/**
 * return true if IOC firmware is different.
 */
bfa_boolean_t
bfa_ioc_fw_mismatch(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2233 2234 2235
	return bfa_fsm_cmp_state(ioc, bfa_ioc_sm_reset) ||
		bfa_fsm_cmp_state(&ioc->iocpf, bfa_iocpf_sm_fwcheck) ||
		bfa_fsm_cmp_state(&ioc->iocpf, bfa_iocpf_sm_mismatch);
2236 2237 2238 2239 2240 2241 2242
}

#define bfa_ioc_state_disabled(__sm)		\
	(((__sm) == BFI_IOC_UNINIT) ||		\
	 ((__sm) == BFI_IOC_INITING) ||		\
	 ((__sm) == BFI_IOC_HWINIT) ||		\
	 ((__sm) == BFI_IOC_DISABLED) ||	\
2243
	 ((__sm) == BFI_IOC_FAIL) ||		\
2244 2245 2246 2247 2248 2249 2250 2251 2252
	 ((__sm) == BFI_IOC_CFG_DISABLED))

/**
 * Check if adapter is disabled -- both IOCs should be in a disabled
 * state.
 */
bfa_boolean_t
bfa_ioc_adapter_is_disabled(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2253 2254
	u32	ioc_state;
	bfa_os_addr_t	rb = ioc->pcidev.pci_bar_kva;
2255 2256 2257 2258 2259 2260 2261 2262

	if (!bfa_fsm_cmp_state(ioc, bfa_ioc_sm_disabled))
		return BFA_FALSE;

	ioc_state = bfa_reg_read(rb + BFA_IOC0_STATE_REG);
	if (!bfa_ioc_state_disabled(ioc_state))
		return BFA_FALSE;

K
Krishna Gudipati 已提交
2263 2264 2265 2266 2267
	if (ioc->pcidev.device_id != BFA_PCI_DEVICE_ID_FC_8G1P) {
		ioc_state = bfa_reg_read(rb + BFA_IOC1_STATE_REG);
		if (!bfa_ioc_state_disabled(ioc_state))
			return BFA_FALSE;
	}
2268 2269 2270 2271 2272 2273

	return BFA_TRUE;
}

/**
 * Add to IOC heartbeat failure notification queue. To be used by common
K
Krishna Gudipati 已提交
2274
 * modules such as cee, port, diag.
2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287
 */
void
bfa_ioc_hbfail_register(struct bfa_ioc_s *ioc,
			struct bfa_ioc_hbfail_notify_s *notify)
{
	list_add_tail(&notify->qe, &ioc->hb_notify_q);
}

#define BFA_MFG_NAME "Brocade"
void
bfa_ioc_get_adapter_attr(struct bfa_ioc_s *ioc,
			 struct bfa_adapter_attr_s *ad_attr)
{
K
Krishna Gudipati 已提交
2288
	struct bfi_ioc_attr_s	*ioc_attr;
2289 2290

	ioc_attr = ioc->attr;
2291 2292 2293 2294 2295

	bfa_ioc_get_adapter_serial_num(ioc, ad_attr->serial_num);
	bfa_ioc_get_adapter_fw_ver(ioc, ad_attr->fw_ver);
	bfa_ioc_get_adapter_optrom_ver(ioc, ad_attr->optrom_ver);
	bfa_ioc_get_adapter_manufacturer(ioc, ad_attr->manufacturer);
2296
	memcpy(&ad_attr->vpd, &ioc_attr->vpd,
2297 2298
		      sizeof(struct bfa_mfg_vpd_s));

2299 2300
	ad_attr->nports = bfa_ioc_get_nports(ioc);
	ad_attr->max_speed = bfa_ioc_speed_sup(ioc);
2301

2302 2303 2304
	bfa_ioc_get_adapter_model(ioc, ad_attr->model);
	/* For now, model descr uses same model string */
	bfa_ioc_get_adapter_model(ioc, ad_attr->model_descr);
2305

2306 2307 2308
	ad_attr->card_type = ioc_attr->card_type;
	ad_attr->is_mezz = bfa_mfg_is_mezz(ioc_attr->card_type);

2309 2310 2311 2312 2313 2314
	if (BFI_ADAPTER_IS_SPECIAL(ioc_attr->adapter_prop))
		ad_attr->prototype = 1;
	else
		ad_attr->prototype = 0;

	ad_attr->pwwn = bfa_ioc_get_pwwn(ioc);
K
Krishna Gudipati 已提交
2315
	ad_attr->mac  = bfa_ioc_get_mac(ioc);
2316 2317 2318 2319 2320

	ad_attr->pcie_gen = ioc_attr->pcie_gen;
	ad_attr->pcie_lanes = ioc_attr->pcie_lanes;
	ad_attr->pcie_lanes_orig = ioc_attr->pcie_lanes_orig;
	ad_attr->asic_rev = ioc_attr->asic_rev;
2321 2322

	bfa_ioc_get_pci_chip_rev(ioc, ad_attr->hw_ver);
2323 2324

	ad_attr->cna_capable = ioc->cna;
K
Krishna Gudipati 已提交
2325
	ad_attr->trunk_capable = (ad_attr->nports > 1) && !ioc->cna;
2326 2327
}

2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342
enum bfa_ioc_type_e
bfa_ioc_get_type(struct bfa_ioc_s *ioc)
{
	if (!ioc->ctdev || ioc->fcmode)
		return BFA_IOC_TYPE_FC;
	else if (ioc->ioc_mc == BFI_MC_IOCFC)
		return BFA_IOC_TYPE_FCoE;
	else if (ioc->ioc_mc == BFI_MC_LL)
		return BFA_IOC_TYPE_LL;
	else {
		bfa_assert(ioc->ioc_mc == BFI_MC_LL);
		return BFA_IOC_TYPE_LL;
	}
}

2343 2344 2345
void
bfa_ioc_get_adapter_serial_num(struct bfa_ioc_s *ioc, char *serial_num)
{
2346 2347
	memset((void *)serial_num, 0, BFA_ADAPTER_SERIAL_NUM_LEN);
	memcpy((void *)serial_num,
2348 2349 2350 2351 2352 2353 2354
			(void *)ioc->attr->brcd_serialnum,
			BFA_ADAPTER_SERIAL_NUM_LEN);
}

void
bfa_ioc_get_adapter_fw_ver(struct bfa_ioc_s *ioc, char *fw_ver)
{
2355 2356
	memset((void *)fw_ver, 0, BFA_VERSION_LEN);
	memcpy(fw_ver, ioc->attr->fw_version, BFA_VERSION_LEN);
2357 2358 2359 2360 2361 2362 2363
}

void
bfa_ioc_get_pci_chip_rev(struct bfa_ioc_s *ioc, char *chip_rev)
{
	bfa_assert(chip_rev);

2364
	memset((void *)chip_rev, 0, BFA_IOC_CHIP_REV_LEN);
2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376

	chip_rev[0] = 'R';
	chip_rev[1] = 'e';
	chip_rev[2] = 'v';
	chip_rev[3] = '-';
	chip_rev[4] = ioc->attr->asic_rev;
	chip_rev[5] = '\0';
}

void
bfa_ioc_get_adapter_optrom_ver(struct bfa_ioc_s *ioc, char *optrom_ver)
{
2377 2378
	memset((void *)optrom_ver, 0, BFA_VERSION_LEN);
	memcpy(optrom_ver, ioc->attr->optrom_version,
K
Krishna Gudipati 已提交
2379
		      BFA_VERSION_LEN);
2380 2381 2382 2383 2384
}

void
bfa_ioc_get_adapter_manufacturer(struct bfa_ioc_s *ioc, char *manufacturer)
{
2385 2386
	memset((void *)manufacturer, 0, BFA_ADAPTER_MFG_NAME_LEN);
	memcpy(manufacturer, BFA_MFG_NAME, BFA_ADAPTER_MFG_NAME_LEN);
2387 2388 2389 2390 2391
}

void
bfa_ioc_get_adapter_model(struct bfa_ioc_s *ioc, char *model)
{
K
Krishna Gudipati 已提交
2392
	struct bfi_ioc_attr_s	*ioc_attr;
2393 2394

	bfa_assert(model);
2395
	memset((void *)model, 0, BFA_ADAPTER_MODEL_NAME_LEN);
2396 2397 2398 2399 2400 2401

	ioc_attr = ioc->attr;

	/**
	 * model name
	 */
2402
	snprintf(model, BFA_ADAPTER_MODEL_NAME_LEN, "%s-%u",
K
Krishna Gudipati 已提交
2403
		BFA_MFG_NAME, ioc_attr->card_type);
2404 2405 2406 2407 2408
}

enum bfa_ioc_state
bfa_ioc_get_state(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443
	enum bfa_iocpf_state iocpf_st;
	enum bfa_ioc_state ioc_st = bfa_sm_to_state(ioc_sm_table, ioc->fsm);

	if (ioc_st == BFA_IOC_ENABLING ||
		ioc_st == BFA_IOC_FAIL || ioc_st == BFA_IOC_INITFAIL) {

		iocpf_st = bfa_sm_to_state(iocpf_sm_table, ioc->iocpf.fsm);

		switch (iocpf_st) {
		case BFA_IOCPF_SEMWAIT:
			ioc_st = BFA_IOC_SEMWAIT;
			break;

		case BFA_IOCPF_HWINIT:
			ioc_st = BFA_IOC_HWINIT;
			break;

		case BFA_IOCPF_FWMISMATCH:
			ioc_st = BFA_IOC_FWMISMATCH;
			break;

		case BFA_IOCPF_FAIL:
			ioc_st = BFA_IOC_FAIL;
			break;

		case BFA_IOCPF_INITFAIL:
			ioc_st = BFA_IOC_INITFAIL;
			break;

		default:
			break;
		}
	}

	return ioc_st;
2444 2445
}

2446 2447 2448
void
bfa_ioc_get_attr(struct bfa_ioc_s *ioc, struct bfa_ioc_attr_s *ioc_attr)
{
2449
	memset((void *)ioc_attr, 0, sizeof(struct bfa_ioc_attr_s));
2450

2451
	ioc_attr->state = bfa_ioc_get_state(ioc);
2452 2453
	ioc_attr->port_id = ioc->port_id;

2454
	ioc_attr->ioc_type = bfa_ioc_get_type(ioc);
2455 2456 2457 2458 2459

	bfa_ioc_get_adapter_attr(ioc, &ioc_attr->adapter_attr);

	ioc_attr->pci_attr.device_id = ioc->pcidev.device_id;
	ioc_attr->pci_attr.pcifn = ioc->pcidev.pci_func;
2460
	bfa_ioc_get_pci_chip_rev(ioc, ioc_attr->pci_attr.chip_rev);
2461 2462 2463
}

/**
K
Krishna Gudipati 已提交
2464
 *  hal_wwn_public
2465 2466 2467 2468
 */
wwn_t
bfa_ioc_get_pwwn(struct bfa_ioc_s *ioc)
{
J
Jing Huang 已提交
2469
	return ioc->attr->pwwn;
2470 2471 2472 2473 2474
}

wwn_t
bfa_ioc_get_nwwn(struct bfa_ioc_s *ioc)
{
J
Jing Huang 已提交
2475
	return ioc->attr->nwwn;
2476 2477 2478 2479 2480
}

u64
bfa_ioc_get_adid(struct bfa_ioc_s *ioc)
{
J
Jing Huang 已提交
2481
	return ioc->attr->mfg_pwwn;
2482 2483 2484 2485 2486
}

mac_t
bfa_ioc_get_mac(struct bfa_ioc_s *ioc)
{
J
Jing Huang 已提交
2487
	/*
K
Krishna Gudipati 已提交
2488
	 * Check the IOC type and return the appropriate MAC
J
Jing Huang 已提交
2489 2490
	 */
	if (bfa_ioc_get_type(ioc) == BFA_IOC_TYPE_FCoE)
K
Krishna Gudipati 已提交
2491
		return ioc->attr->fcoe_mac;
J
Jing Huang 已提交
2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510
	else
		return ioc->attr->mac;
}

wwn_t
bfa_ioc_get_mfg_pwwn(struct bfa_ioc_s *ioc)
{
	return ioc->attr->mfg_pwwn;
}

wwn_t
bfa_ioc_get_mfg_nwwn(struct bfa_ioc_s *ioc)
{
	return ioc->attr->mfg_nwwn;
}

mac_t
bfa_ioc_get_mfg_mac(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2511
	mac_t	m;
2512

K
Krishna Gudipati 已提交
2513 2514 2515 2516 2517 2518
	m = ioc->attr->mfg_mac;
	if (bfa_mfg_is_old_wwn_mac_model(ioc->attr->card_type))
		m.mac[MAC_ADDRLEN - 1] += bfa_ioc_pcifn(ioc);
	else
		bfa_mfg_increment_wwn_mac(&(m.mac[MAC_ADDRLEN-3]),
			bfa_ioc_pcifn(ioc));
2519

K
Krishna Gudipati 已提交
2520
	return m;
2521 2522 2523 2524 2525
}

bfa_boolean_t
bfa_ioc_get_fcmode(struct bfa_ioc_s *ioc)
{
J
Jing Huang 已提交
2526
	return ioc->fcmode || !bfa_asic_id_ct(ioc->pcidev.device_id);
2527 2528 2529 2530 2531 2532 2533 2534
}

/**
 * Retrieve saved firmware trace from a prior IOC failure.
 */
bfa_status_t
bfa_ioc_debug_fwsave(struct bfa_ioc_s *ioc, void *trcdata, int *trclen)
{
K
Krishna Gudipati 已提交
2535
	int	tlen;
2536 2537 2538 2539 2540 2541 2542 2543

	if (ioc->dbg_fwsave_len == 0)
		return BFA_STATUS_ENOFSAVE;

	tlen = *trclen;
	if (tlen > ioc->dbg_fwsave_len)
		tlen = ioc->dbg_fwsave_len;

2544
	memcpy(trcdata, ioc->dbg_fwsave, tlen);
2545 2546 2547 2548
	*trclen = tlen;
	return BFA_STATUS_OK;
}

2549 2550 2551 2552 2553 2554 2555 2556 2557
/**
 * Clear saved firmware trace
 */
void
bfa_ioc_debug_fwsave_clear(struct bfa_ioc_s *ioc)
{
	ioc->dbg_fwsave_once = BFA_TRUE;
}

2558 2559 2560 2561 2562 2563
/**
 * Retrieve saved firmware trace from a prior IOC failure.
 */
bfa_status_t
bfa_ioc_debug_fwtrc(struct bfa_ioc_s *ioc, void *trcdata, int *trclen)
{
K
Krishna Gudipati 已提交
2564 2565 2566
	u32 loff = BFA_DBG_FWTRC_OFF(bfa_ioc_portid(ioc));
	int tlen;
	bfa_status_t status;
2567 2568 2569 2570 2571 2572 2573

	bfa_trc(ioc, *trclen);

	tlen = *trclen;
	if (tlen > BFA_DBG_FWTRC_LEN)
		tlen = BFA_DBG_FWTRC_LEN;

K
Krishna Gudipati 已提交
2574 2575 2576 2577
	status = bfa_ioc_smem_read(ioc, trcdata, loff, tlen);
	*trclen = tlen;
	return status;
}
2578

K
Krishna Gudipati 已提交
2579 2580 2581 2582 2583
static void
bfa_ioc_send_fwsync(struct bfa_ioc_s *ioc)
{
	struct bfa_mbox_cmd_s cmd;
	struct bfi_ioc_ctrl_req_s *req = (struct bfi_ioc_ctrl_req_s *) cmd.msg;
2584

K
Krishna Gudipati 已提交
2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626 2627
	bfi_h2i_set(req->mh, BFI_MC_IOC, BFI_IOC_H2I_DBG_SYNC,
		    bfa_ioc_portid(ioc));
	req->ioc_class = ioc->ioc_mc;
	bfa_ioc_mbox_queue(ioc, &cmd);
}

static void
bfa_ioc_fwsync(struct bfa_ioc_s *ioc)
{
	u32 fwsync_iter = 1000;

	bfa_ioc_send_fwsync(ioc);

	/**
	 * After sending a fw sync mbox command wait for it to
	 * take effect.  We will not wait for a response because
	 *    1. fw_sync mbox cmd doesn't have a response.
	 *    2. Even if we implement that,  interrupts might not
	 *	 be enabled when we call this function.
	 * So, just keep checking if any mbox cmd is pending, and
	 * after waiting for a reasonable amount of time, go ahead.
	 * It is possible that fw has crashed and the mbox command
	 * is never acknowledged.
	 */
	while (bfa_ioc_mbox_cmd_pending(ioc) && fwsync_iter > 0)
		fwsync_iter--;
}

/**
 * Dump firmware smem
 */
bfa_status_t
bfa_ioc_debug_fwcore(struct bfa_ioc_s *ioc, void *buf,
				u32 *offset, int *buflen)
{
	u32 loff;
	int dlen;
	bfa_status_t status;
	u32 smem_len = BFA_IOC_FW_SMEM_SIZE(ioc);

	if (*offset >= smem_len) {
		*offset = *buflen = 0;
		return BFA_STATUS_EINVAL;
2628
	}
2629

K
Krishna Gudipati 已提交
2630 2631 2632 2633 2634 2635
	loff = *offset;
	dlen = *buflen;

	/**
	 * First smem read, sync smem before proceeding
	 * No need to sync before reading every chunk.
2636
	 */
K
Krishna Gudipati 已提交
2637 2638
	if (loff == 0)
		bfa_ioc_fwsync(ioc);
2639

K
Krishna Gudipati 已提交
2640 2641
	if ((loff + dlen) >= smem_len)
		dlen = smem_len - loff;
2642

K
Krishna Gudipati 已提交
2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701 2702
	status = bfa_ioc_smem_read(ioc, buf, loff, dlen);

	if (status != BFA_STATUS_OK) {
		*offset = *buflen = 0;
		return status;
	}

	*offset += dlen;

	if (*offset >= smem_len)
		*offset = 0;

	*buflen = dlen;

	return status;
}

/**
 * Firmware statistics
 */
bfa_status_t
bfa_ioc_fw_stats_get(struct bfa_ioc_s *ioc, void *stats)
{
	u32 loff = BFI_IOC_FWSTATS_OFF + \
		BFI_IOC_FWSTATS_SZ * (bfa_ioc_portid(ioc));
	int tlen;
	bfa_status_t status;

	if (ioc->stats_busy) {
		bfa_trc(ioc, ioc->stats_busy);
		return BFA_STATUS_DEVBUSY;
	}
	ioc->stats_busy = BFA_TRUE;

	tlen = sizeof(struct bfa_fw_stats_s);
	status = bfa_ioc_smem_read(ioc, stats, loff, tlen);

	ioc->stats_busy = BFA_FALSE;
	return status;
}

bfa_status_t
bfa_ioc_fw_stats_clear(struct bfa_ioc_s *ioc)
{
	u32 loff = BFI_IOC_FWSTATS_OFF + \
		BFI_IOC_FWSTATS_SZ * (bfa_ioc_portid(ioc));
	int tlen;
	bfa_status_t status;

	if (ioc->stats_busy) {
		bfa_trc(ioc, ioc->stats_busy);
		return BFA_STATUS_DEVBUSY;
	}
	ioc->stats_busy = BFA_TRUE;

	tlen = sizeof(struct bfa_fw_stats_s);
	status = bfa_ioc_smem_clr(ioc, loff, tlen);

	ioc->stats_busy = BFA_FALSE;
	return status;
2703 2704 2705 2706 2707 2708 2709 2710
}

/**
 * Save firmware trace if configured.
 */
static void
bfa_ioc_debug_save(struct bfa_ioc_s *ioc)
{
K
Krishna Gudipati 已提交
2711
	int		tlen;
2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734

	if (ioc->dbg_fwsave_len) {
		tlen = ioc->dbg_fwsave_len;
		bfa_ioc_debug_fwtrc(ioc, ioc->dbg_fwsave, &tlen);
	}
}

/**
 * Firmware failure detected. Start recovery actions.
 */
static void
bfa_ioc_recover(struct bfa_ioc_s *ioc)
{
	if (ioc->dbg_fwsave_once) {
		ioc->dbg_fwsave_once = BFA_FALSE;
		bfa_ioc_debug_save(ioc);
	}

	bfa_ioc_stats(ioc, ioc_hbfails);
	bfa_fsm_send_event(ioc, IOC_E_HBFAIL);
}

static void
J
Jing Huang 已提交
2735
bfa_ioc_check_attr_wwns(struct bfa_ioc_s *ioc)
2736
{
J
Jing Huang 已提交
2737 2738
	if (bfa_ioc_get_type(ioc) == BFA_IOC_TYPE_LL)
		return;
K
Krishna Gudipati 已提交
2739 2740 2741 2742 2743
}

/**
 *  hal_iocpf_pvt BFA IOC PF private functions
 */
J
Jing Huang 已提交
2744

K
Krishna Gudipati 已提交
2745 2746 2747 2748
static void
bfa_iocpf_enable(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_ENABLE);
2749 2750
}

K
Krishna Gudipati 已提交
2751 2752 2753 2754 2755 2756 2757 2758 2759 2760 2761 2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870
static void
bfa_iocpf_disable(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_DISABLE);
}

static void
bfa_iocpf_fail(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_FAIL);
}

static void
bfa_iocpf_initfail(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_INITFAIL);
}

static void
bfa_iocpf_getattrfail(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_GETATTRFAIL);
}

static void
bfa_iocpf_stop(struct bfa_ioc_s *ioc)
{
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_STOP);
}

static void
bfa_iocpf_timeout(void *ioc_arg)
{
	struct bfa_ioc_s  *ioc = (struct bfa_ioc_s *) ioc_arg;

	bfa_trc(ioc, 0);
	bfa_fsm_send_event(&ioc->iocpf, IOCPF_E_TIMEOUT);
}

static void
bfa_iocpf_sem_timeout(void *ioc_arg)
{
	struct bfa_ioc_s  *ioc = (struct bfa_ioc_s *) ioc_arg;

	bfa_ioc_hw_sem_get(ioc);
}

/**
 *  bfa timer function
 */
void
bfa_timer_init(struct bfa_timer_mod_s *mod)
{
	INIT_LIST_HEAD(&mod->timer_q);
}

void
bfa_timer_beat(struct bfa_timer_mod_s *mod)
{
	struct list_head *qh = &mod->timer_q;
	struct list_head *qe, *qe_next;
	struct bfa_timer_s *elem;
	struct list_head timedout_q;

	INIT_LIST_HEAD(&timedout_q);

	qe = bfa_q_next(qh);

	while (qe != qh) {
		qe_next = bfa_q_next(qe);

		elem = (struct bfa_timer_s *) qe;
		if (elem->timeout <= BFA_TIMER_FREQ) {
			elem->timeout = 0;
			list_del(&elem->qe);
			list_add_tail(&elem->qe, &timedout_q);
		} else {
			elem->timeout -= BFA_TIMER_FREQ;
		}

		qe = qe_next;	/* go to next elem */
	}

	/*
	 * Pop all the timeout entries
	 */
	while (!list_empty(&timedout_q)) {
		bfa_q_deq(&timedout_q, &elem);
		elem->timercb(elem->arg);
	}
}

/**
 * Should be called with lock protection
 */
void
bfa_timer_begin(struct bfa_timer_mod_s *mod, struct bfa_timer_s *timer,
		    void (*timercb) (void *), void *arg, unsigned int timeout)
{

	bfa_assert(timercb != NULL);
	bfa_assert(!bfa_q_is_on_q(&mod->timer_q, timer));

	timer->timeout = timeout;
	timer->timercb = timercb;
	timer->arg = arg;

	list_add_tail(&timer->qe, &mod->timer_q);
}

/**
 * Should be called with lock protection
 */
void
bfa_timer_stop(struct bfa_timer_s *timer)
{
	bfa_assert(!list_empty(&timer->qe));

	list_del(&timer->qe);
}