1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /*
3  * Copyright (C) 2017 Intel Deutschland GmbH
4  * Copyright (C) 2019-2021 Intel Corporation
5  */
6 #include "iwl-drv.h"
7 #include "runtime.h"
8 #include "dbg.h"
9 #include "debugfs.h"
10 
11 #include "fw/api/system.h"
12 #include "fw/api/commands.h"
13 #include "fw/api/rx.h"
14 #include "fw/api/datapath.h"
15 
16 void iwl_fw_runtime_init(struct iwl_fw_runtime *fwrt, struct iwl_trans *trans,
17 			const struct iwl_fw *fw,
18 			const struct iwl_fw_runtime_ops *ops, void *ops_ctx,
19 			const struct iwl_dump_sanitize_ops *sanitize_ops,
20 			void *sanitize_ctx,
21 			struct dentry *dbgfs_dir)
22 {
23 	int i;
24 
25 	memset(fwrt, 0, sizeof(*fwrt));
26 	fwrt->trans = trans;
27 	fwrt->fw = fw;
28 	fwrt->dev = trans->dev;
29 	fwrt->dump.conf = FW_DBG_INVALID;
30 	fwrt->ops = ops;
31 	fwrt->sanitize_ops = sanitize_ops;
32 	fwrt->sanitize_ctx = sanitize_ctx;
33 	fwrt->ops_ctx = ops_ctx;
34 	for (i = 0; i < IWL_FW_RUNTIME_DUMP_WK_NUM; i++) {
35 		fwrt->dump.wks[i].idx = i;
36 		INIT_DELAYED_WORK(&fwrt->dump.wks[i].wk, iwl_fw_error_dump_wk);
37 	}
38 	iwl_fwrt_dbgfs_register(fwrt, dbgfs_dir);
39 }
40 IWL_EXPORT_SYMBOL(iwl_fw_runtime_init);
41 
42 void iwl_fw_runtime_suspend(struct iwl_fw_runtime *fwrt)
43 {
44 	iwl_fw_suspend_timestamp(fwrt);
45 	iwl_dbg_tlv_time_point(fwrt, IWL_FW_INI_TIME_POINT_HOST_D3_START, NULL);
46 }
47 IWL_EXPORT_SYMBOL(iwl_fw_runtime_suspend);
48 
49 void iwl_fw_runtime_resume(struct iwl_fw_runtime *fwrt)
50 {
51 	iwl_dbg_tlv_time_point(fwrt, IWL_FW_INI_TIME_POINT_HOST_D3_END, NULL);
52 	iwl_fw_resume_timestamp(fwrt);
53 }
54 IWL_EXPORT_SYMBOL(iwl_fw_runtime_resume);
55 
56 /* set device type and latency */
57 int iwl_set_soc_latency(struct iwl_fw_runtime *fwrt)
58 {
59 	struct iwl_soc_configuration_cmd cmd = {};
60 	struct iwl_host_cmd hcmd = {
61 		.id = iwl_cmd_id(SOC_CONFIGURATION_CMD, SYSTEM_GROUP, 0),
62 		.data[0] = &cmd,
63 		.len[0] = sizeof(cmd),
64 	};
65 	int ret;
66 
67 	/*
68 	 * In VER_1 of this command, the discrete value is considered
69 	 * an integer; In VER_2, it's a bitmask.  Since we have only 2
70 	 * values in VER_1, this is backwards-compatible with VER_2,
71 	 * as long as we don't set any other bits.
72 	 */
73 	if (!fwrt->trans->trans_cfg->integrated)
74 		cmd.flags = cpu_to_le32(SOC_CONFIG_CMD_FLAGS_DISCRETE);
75 
76 	BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_NONE !=
77 		     SOC_FLAGS_LTR_APPLY_DELAY_NONE);
78 	BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_200US !=
79 		     SOC_FLAGS_LTR_APPLY_DELAY_200);
80 	BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_2500US !=
81 		     SOC_FLAGS_LTR_APPLY_DELAY_2500);
82 	BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_1820US !=
83 		     SOC_FLAGS_LTR_APPLY_DELAY_1820);
84 
85 	if (fwrt->trans->trans_cfg->ltr_delay != IWL_CFG_TRANS_LTR_DELAY_NONE &&
86 	    !WARN_ON(!fwrt->trans->trans_cfg->integrated))
87 		cmd.flags |= le32_encode_bits(fwrt->trans->trans_cfg->ltr_delay,
88 					      SOC_FLAGS_LTR_APPLY_DELAY_MASK);
89 
90 	if (iwl_fw_lookup_cmd_ver(fwrt->fw, IWL_ALWAYS_LONG_GROUP,
91 				  SCAN_REQ_UMAC,
92 				  IWL_FW_CMD_VER_UNKNOWN) >= 2 &&
93 	    fwrt->trans->trans_cfg->low_latency_xtal)
94 		cmd.flags |= cpu_to_le32(SOC_CONFIG_CMD_FLAGS_LOW_LATENCY);
95 
96 	cmd.latency = cpu_to_le32(fwrt->trans->trans_cfg->xtal_latency);
97 
98 	ret = iwl_trans_send_cmd(fwrt->trans, &hcmd);
99 	if (ret)
100 		IWL_ERR(fwrt, "Failed to set soc latency: %d\n", ret);
101 	return ret;
102 }
103 IWL_EXPORT_SYMBOL(iwl_set_soc_latency);
104 
105 int iwl_configure_rxq(struct iwl_fw_runtime *fwrt)
106 {
107 	int i, num_queues, size, ret;
108 	struct iwl_rfh_queue_config *cmd;
109 	struct iwl_host_cmd hcmd = {
110 		.id = WIDE_ID(DATA_PATH_GROUP, RFH_QUEUE_CONFIG_CMD),
111 		.dataflags[0] = IWL_HCMD_DFL_NOCOPY,
112 	};
113 
114 	/*
115 	 * The default queue is configured via context info, so if we
116 	 * have a single queue, there's nothing to do here.
117 	 */
118 	if (fwrt->trans->num_rx_queues == 1)
119 		return 0;
120 
121 	if (fwrt->trans->trans_cfg->device_family < IWL_DEVICE_FAMILY_22000)
122 		return 0;
123 
124 	/* skip the default queue */
125 	num_queues = fwrt->trans->num_rx_queues - 1;
126 
127 	size = struct_size(cmd, data, num_queues);
128 
129 	cmd = kzalloc(size, GFP_KERNEL);
130 	if (!cmd)
131 		return -ENOMEM;
132 
133 	cmd->num_queues = num_queues;
134 
135 	for (i = 0; i < num_queues; i++) {
136 		struct iwl_trans_rxq_dma_data data;
137 
138 		cmd->data[i].q_num = i + 1;
139 		iwl_trans_get_rxq_dma_data(fwrt->trans, i + 1, &data);
140 
141 		cmd->data[i].fr_bd_cb = cpu_to_le64(data.fr_bd_cb);
142 		cmd->data[i].urbd_stts_wrptr =
143 			cpu_to_le64(data.urbd_stts_wrptr);
144 		cmd->data[i].ur_bd_cb = cpu_to_le64(data.ur_bd_cb);
145 		cmd->data[i].fr_bd_wid = cpu_to_le32(data.fr_bd_wid);
146 	}
147 
148 	hcmd.data[0] = cmd;
149 	hcmd.len[0] = size;
150 
151 	ret = iwl_trans_send_cmd(fwrt->trans, &hcmd);
152 
153 	kfree(cmd);
154 
155 	if (ret)
156 		IWL_ERR(fwrt, "Failed to configure RX queues: %d\n", ret);
157 
158 	return ret;
159 }
160 IWL_EXPORT_SYMBOL(iwl_configure_rxq);
161