marvell/libertas/cmd.c

16 #include "cmd.h"
64  *  @cmd:	the command ID
68 static u8 is_command_allowed_in_ps(u16 cmd)
70 	switch (cmd) {
91 	struct cmd_ds_get_hw_spec cmd;
95 	memset(&cmd, 0, sizeof(cmd));
96 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
97 	memcpy(cmd.permanentaddr, priv->current_addr, ETH_ALEN);
98 	ret = lbs_cmd_with_response(priv, CMD_GET_HW_SPEC, &cmd);
102 	priv->fwcapinfo = le32_to_cpu(cmd.fwcapinfo);
106 	priv->fwrelease = le32_to_cpu(cmd.fwrelease);
115 		cmd.permanentaddr,
122 		    cmd.hwifversion, cmd.version);
132 		priv->regioncode = (le16_to_cpu(cmd.regioncode) >> 8) & 0xFF;
134 		priv->regioncode = le16_to_cpu(cmd.regioncode) & 0xFF;
150 		memmove(priv->current_addr, cmd.permanentaddr, ETH_ALEN);
232 	struct cmd_ds_802_11_ps_mode cmd;
235 	memset(&cmd, 0, sizeof(cmd));
236 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
237 	cmd.action = cpu_to_le16(cmd_action);
241 		cmd.multipledtim = cpu_to_le16(1);  /* Default DTIM multiple */
254 		ret = lbs_cmd_with_response(priv, CMD_802_11_PS_MODE, &cmd);
256 		lbs_cmd_async(priv, CMD_802_11_PS_MODE, &cmd.hdr, sizeof (cmd));
265 	struct cmd_ds_802_11_sleep_params cmd;
269 		memset(&cmd, 0, sizeof(cmd));
271 		cmd.error = cpu_to_le16(sp->sp_error);
272 		cmd.offset = cpu_to_le16(sp->sp_offset);
273 		cmd.stabletime = cpu_to_le16(sp->sp_stabletime);
274 		cmd.calcontrol = sp->sp_calcontrol;
275 		cmd.externalsleepclk = sp->sp_extsleepclk;
276 		cmd.reserved = cpu_to_le16(sp->sp_reserved);
278 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
279 	cmd.action = cpu_to_le16(cmd_action);
281 	ret = lbs_cmd_with_response(priv, CMD_802_11_SLEEP_PARAMS, &cmd);
286 			    le16_to_cpu(cmd.error), le16_to_cpu(cmd.offset),
287 			    le16_to_cpu(cmd.stabletime), cmd.calcontrol,
288 			    cmd.externalsleepclk);
290 		sp->sp_error = le16_to_cpu(cmd.error);
291 		sp->sp_offset = le16_to_cpu(cmd.offset);
292 		sp->sp_stabletime = le16_to_cpu(cmd.stabletime);
293 		sp->sp_calcontrol = cmd.calcontrol;
294 		sp->sp_extsleepclk = cmd.externalsleepclk;
295 		sp->sp_reserved = le16_to_cpu(cmd.reserved);
351 		struct cmd_header *cmd)
361 	struct cmd_header cmd;
367 			memset(&cmd, 0, sizeof(cmd));
379 						&cmd,
380 						sizeof(cmd),
419 	struct cmd_ds_802_11_snmp_mib cmd;
422 	memset(&cmd, 0, sizeof (cmd));
423 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
424 	cmd.action = cpu_to_le16(CMD_ACT_SET);
425 	cmd.oid = cpu_to_le16((u16) oid);
429 		cmd.bufsize = cpu_to_le16(sizeof(u8));
430 		cmd.value[0] = val;
437 		cmd.bufsize = cpu_to_le16(sizeof(u16));
438 		*((__le16 *)(&cmd.value)) = cpu_to_le16(val);
447 		    le16_to_cpu(cmd.oid), le16_to_cpu(cmd.bufsize), val);
449 	ret = lbs_cmd_with_response(priv, CMD_802_11_SNMP_MIB, &cmd);
466 	struct cmd_ds_802_11_snmp_mib cmd;
469 	memset(&cmd, 0, sizeof (cmd));
470 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
471 	cmd.action = cpu_to_le16(CMD_ACT_GET);
472 	cmd.oid = cpu_to_le16(oid);
474 	ret = lbs_cmd_with_response(priv, CMD_802_11_SNMP_MIB, &cmd);
478 	switch (le16_to_cpu(cmd.bufsize)) {
480 		*out_val = cmd.value[0];
483 		*out_val = le16_to_cpu(*((__le16 *)(&cmd.value)));
487 		            oid, le16_to_cpu(cmd.bufsize));
508 	struct cmd_ds_802_11_rf_tx_power cmd;
511 	memset(&cmd, 0, sizeof(cmd));
512 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
513 	cmd.action = cpu_to_le16(CMD_ACT_GET);
515 	ret = lbs_cmd_with_response(priv, CMD_802_11_RF_TX_POWER, &cmd);
517 		*curlevel = le16_to_cpu(cmd.curlevel);
519 			*minlevel = cmd.minlevel;
521 			*maxlevel = cmd.maxlevel;
537 	struct cmd_ds_802_11_rf_tx_power cmd;
540 	memset(&cmd, 0, sizeof(cmd));
541 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
542 	cmd.action = cpu_to_le16(CMD_ACT_SET);
543 	cmd.curlevel = cpu_to_le16(dbm);
547 	ret = lbs_cmd_with_response(priv, CMD_802_11_RF_TX_POWER, &cmd);
563 	struct cmd_ds_802_11_monitor_mode cmd;
566 	memset(&cmd, 0, sizeof(cmd));
567 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
568 	cmd.action = cpu_to_le16(CMD_ACT_SET);
570 		cmd.mode = cpu_to_le16(0x1);
574 	ret = lbs_cmd_with_response(priv, CMD_802_11_MONITOR_MODE, &cmd);
592 	struct cmd_ds_802_11_rf_channel cmd;
595 	memset(&cmd, 0, sizeof(cmd));
596 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
597 	cmd.action = cpu_to_le16(CMD_OPT_802_11_RF_CHANNEL_GET);
599 	ret = lbs_cmd_with_response(priv, CMD_802_11_RF_CHANNEL, &cmd);
603 	ret = le16_to_cpu(cmd.channel);
634 	struct cmd_ds_802_11_rf_channel cmd;
640 	memset(&cmd, 0, sizeof(cmd));
641 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
642 	cmd.action = cpu_to_le16(CMD_OPT_802_11_RF_CHANNEL_SET);
643 	cmd.channel = cpu_to_le16(channel);
645 	ret = lbs_cmd_with_response(priv, CMD_802_11_RF_CHANNEL, &cmd);
649 	priv->channel = (uint8_t) le16_to_cpu(cmd.channel);
668 	struct cmd_ds_802_11_rssi cmd;
674 	memset(&cmd, 0, sizeof(cmd));
675 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
677 	cmd.n_or_snr = cpu_to_le16(8);
679 	ret = lbs_cmd_with_response(priv, CMD_802_11_RSSI, &cmd);
681 		*nf = CAL_NF(le16_to_cpu(cmd.nf));
682 		*rssi = CAL_RSSI(le16_to_cpu(cmd.n_or_snr), le16_to_cpu(cmd.nf));
700 	struct cmd_ds_802_11d_domain_info cmd;
701 	struct mrvl_ie_domain_param_set *domain = &cmd.domain;
715 	memset(&cmd, 0, sizeof(cmd));
716 	cmd.action = cpu_to_le16(CMD_ACT_SET);
796 			(u8 *) &cmd.domain.country_code,
799 	cmd.hdr.size = cpu_to_le16(sizeof(cmd.hdr) +
800 				   sizeof(cmd.action) +
801 				   sizeof(cmd.domain.header) +
802 				   sizeof(cmd.domain.country_code) +
805 	ret = lbs_cmd_with_response(priv, CMD_802_11D_DOMAIN_INFO, &cmd);
824 	struct cmd_ds_reg_access cmd;
829 	memset(&cmd, 0, sizeof(cmd));
830 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
831 	cmd.action = cpu_to_le16(CMD_ACT_GET);
832 	cmd.offset = cpu_to_le16(offset);
841 	ret = lbs_cmd_with_response(priv, reg, &cmd);
844 			*value = cmd.value.bbp_rf;
846 			*value = le32_to_cpu(cmd.value.mac);
866 	struct cmd_ds_reg_access cmd;
869 	memset(&cmd, 0, sizeof(cmd));
870 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
871 	cmd.action = cpu_to_le16(CMD_ACT_SET);
872 	cmd.offset = cpu_to_le16(offset);
875 		cmd.value.bbp_rf = (u8) (value & 0xFF);
877 		cmd.value.mac = cpu_to_le32(value);
883 	ret = lbs_cmd_with_response(priv, reg, &cmd);
900 		lbs_deb_host("DNLD_CMD: cmd size is zero\n");
935 	struct cmd_header *cmd;
941 	cmd = cmdnode->cmdbuf;
945 	cmd->seqnum = cpu_to_le16(priv->seqnum);
949 	cmdsize = le16_to_cpu(cmd->size);
950 	command = le16_to_cpu(cmd->command);
957 		     command, le16_to_cpu(cmd->seqnum), cmdsize);
960 	ret = priv->hw_host_to_card(priv, MVMS_CMD, (u8 *) cmd, cmdsize);
1011 void __lbs_complete_command(struct lbs_private *priv, struct cmd_ctrl_node *cmd,
1020 	list_del_init(&cmd->list);
1022 	cmd->result = result;
1023 	cmd->cmdwaitqwoken = 1;
1024 	wake_up(&cmd->cmdwait_q);
1026 	if (!cmd->callback || cmd->callback == lbs_cmd_async_callback)
1027 		__lbs_cleanup_and_insert_cmd(priv, cmd);
1032 void lbs_complete_command(struct lbs_private *priv, struct cmd_ctrl_node *cmd,
1037 	__lbs_complete_command(priv, cmd, result);
1043 	struct cmd_ds_802_11_radio_control cmd;
1046 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1047 	cmd.action = cpu_to_le16(CMD_ACT_SET);
1048 	cmd.control = 0;
1056 			cmd.control = cpu_to_le16(preamble);
1064 		cmd.control |= cpu_to_le16(0x1);
1066 		cmd.control &= cpu_to_le16(~0x1);
1075 	ret = lbs_cmd_with_response(priv, CMD_802_11_RADIO_CONTROL, &cmd);
1083 	struct cmd_ds_mac_control cmd;
1085 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1086 	cmd.action = cpu_to_le16(priv->mac_control);
1087 	cmd.reserved = 0;
1089 	lbs_cmd_async(priv, CMD_MAC_CONTROL, &cmd.hdr, sizeof(cmd));
1094 	struct cmd_ds_mac_control cmd;
1097 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1098 	cmd.action = cpu_to_le16(priv->mac_control);
1099 	cmd.reserved = 0;
1100 	ret = lbs_cmd_with_response(priv, CMD_MAC_CONTROL, &cmd);
1170 	/* need to check if cmd array is allocated or not */
1240 	struct cmd_header *cmd;
1265 		cmd = cmdnode->cmdbuf;
1267 		if (is_command_allowed_in_ps(le16_to_cpu(cmd->command))) {
1271 				       "EXEC_NEXT_CMD: cannot send cmd 0x%04x in psstate %d\n",
1272 				       le16_to_cpu(cmd->command),
1279 				     le16_to_cpu(cmd->command), priv->psstate);
1292 			if (cmd->command != cpu_to_le16(CMD_802_11_PS_MODE)) {
1314 				struct cmd_ds_802_11_ps_mode *psm = (void *)cmd;
1317 				       "EXEC_NEXT_CMD: PS cmd, action 0x%02x\n",
1322 					       "EXEC_NEXT_CMD: ignore ENTER_PS cmd\n");
1332 					       "EXEC_NEXT_CMD: ignore EXIT_PS cmd in sleep\n");
1348 			    le16_to_cpu(cmd->command));
1458 	struct cmd_ds_802_11_tpc_cfg cmd;
1461 	memset(&cmd, 0, sizeof(cmd));
1462 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1463 	cmd.action = cpu_to_le16(CMD_ACT_SET);
1464 	cmd.enable = !!enable;
1465 	cmd.usesnr = !!usesnr;
1466 	cmd.P0 = p0;
1467 	cmd.P1 = p1;
1468 	cmd.P2 = p2;
1470 	ret = lbs_cmd_with_response(priv, CMD_802_11_TPC_CFG, &cmd);
1490 	struct cmd_ds_802_11_pa_cfg cmd;
1493 	memset(&cmd, 0, sizeof(cmd));
1494 	cmd.hdr.size = cpu_to_le16(sizeof(cmd));
1495 	cmd.action = cpu_to_le16(CMD_ACT_SET);
1496 	cmd.enable = !!enable;
1497 	cmd.P0 = p0;
1498 	cmd.P1 = p1;
1499 	cmd.P2 = p2;
1501 	ret = lbs_cmd_with_response(priv, CMD_802_11_PA_CFG , &cmd);