mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
156 lines
4.3 KiB
156 lines
4.3 KiB
// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause |
|
/* |
|
* Copyright (C) 2017 Intel Deutschland GmbH |
|
* Copyright (C) 2019-2020 Intel Corporation |
|
*/ |
|
#include "iwl-drv.h" |
|
#include "runtime.h" |
|
#include "dbg.h" |
|
#include "debugfs.h" |
|
|
|
#include "fw/api/soc.h" |
|
#include "fw/api/commands.h" |
|
#include "fw/api/rx.h" |
|
#include "fw/api/datapath.h" |
|
|
|
void iwl_fw_runtime_init(struct iwl_fw_runtime *fwrt, struct iwl_trans *trans, |
|
const struct iwl_fw *fw, |
|
const struct iwl_fw_runtime_ops *ops, void *ops_ctx, |
|
struct dentry *dbgfs_dir) |
|
{ |
|
int i; |
|
|
|
memset(fwrt, 0, sizeof(*fwrt)); |
|
fwrt->trans = trans; |
|
fwrt->fw = fw; |
|
fwrt->dev = trans->dev; |
|
fwrt->dump.conf = FW_DBG_INVALID; |
|
fwrt->ops = ops; |
|
fwrt->ops_ctx = ops_ctx; |
|
for (i = 0; i < IWL_FW_RUNTIME_DUMP_WK_NUM; i++) { |
|
fwrt->dump.wks[i].idx = i; |
|
INIT_DELAYED_WORK(&fwrt->dump.wks[i].wk, iwl_fw_error_dump_wk); |
|
} |
|
iwl_fwrt_dbgfs_register(fwrt, dbgfs_dir); |
|
} |
|
IWL_EXPORT_SYMBOL(iwl_fw_runtime_init); |
|
|
|
void iwl_fw_runtime_suspend(struct iwl_fw_runtime *fwrt) |
|
{ |
|
iwl_fw_suspend_timestamp(fwrt); |
|
iwl_dbg_tlv_time_point(fwrt, IWL_FW_INI_TIME_POINT_HOST_D3_START, NULL); |
|
} |
|
IWL_EXPORT_SYMBOL(iwl_fw_runtime_suspend); |
|
|
|
void iwl_fw_runtime_resume(struct iwl_fw_runtime *fwrt) |
|
{ |
|
iwl_dbg_tlv_time_point(fwrt, IWL_FW_INI_TIME_POINT_HOST_D3_END, NULL); |
|
iwl_fw_resume_timestamp(fwrt); |
|
} |
|
IWL_EXPORT_SYMBOL(iwl_fw_runtime_resume); |
|
|
|
/* set device type and latency */ |
|
int iwl_set_soc_latency(struct iwl_fw_runtime *fwrt) |
|
{ |
|
struct iwl_soc_configuration_cmd cmd = {}; |
|
struct iwl_host_cmd hcmd = { |
|
.id = iwl_cmd_id(SOC_CONFIGURATION_CMD, SYSTEM_GROUP, 0), |
|
.data[0] = &cmd, |
|
.len[0] = sizeof(cmd), |
|
}; |
|
int ret; |
|
|
|
/* |
|
* In VER_1 of this command, the discrete value is considered |
|
* an integer; In VER_2, it's a bitmask. Since we have only 2 |
|
* values in VER_1, this is backwards-compatible with VER_2, |
|
* as long as we don't set any other bits. |
|
*/ |
|
if (!fwrt->trans->trans_cfg->integrated) |
|
cmd.flags = cpu_to_le32(SOC_CONFIG_CMD_FLAGS_DISCRETE); |
|
|
|
BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_NONE != |
|
SOC_FLAGS_LTR_APPLY_DELAY_NONE); |
|
BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_200US != |
|
SOC_FLAGS_LTR_APPLY_DELAY_200); |
|
BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_2500US != |
|
SOC_FLAGS_LTR_APPLY_DELAY_2500); |
|
BUILD_BUG_ON(IWL_CFG_TRANS_LTR_DELAY_1820US != |
|
SOC_FLAGS_LTR_APPLY_DELAY_1820); |
|
|
|
if (fwrt->trans->trans_cfg->ltr_delay != IWL_CFG_TRANS_LTR_DELAY_NONE && |
|
!WARN_ON(!fwrt->trans->trans_cfg->integrated)) |
|
cmd.flags |= le32_encode_bits(fwrt->trans->trans_cfg->ltr_delay, |
|
SOC_FLAGS_LTR_APPLY_DELAY_MASK); |
|
|
|
if (iwl_fw_lookup_cmd_ver(fwrt->fw, IWL_ALWAYS_LONG_GROUP, |
|
SCAN_REQ_UMAC, |
|
IWL_FW_CMD_VER_UNKNOWN) >= 2 && |
|
fwrt->trans->trans_cfg->low_latency_xtal) |
|
cmd.flags |= cpu_to_le32(SOC_CONFIG_CMD_FLAGS_LOW_LATENCY); |
|
|
|
cmd.latency = cpu_to_le32(fwrt->trans->trans_cfg->xtal_latency); |
|
|
|
ret = iwl_trans_send_cmd(fwrt->trans, &hcmd); |
|
if (ret) |
|
IWL_ERR(fwrt, "Failed to set soc latency: %d\n", ret); |
|
return ret; |
|
} |
|
IWL_EXPORT_SYMBOL(iwl_set_soc_latency); |
|
|
|
int iwl_configure_rxq(struct iwl_fw_runtime *fwrt) |
|
{ |
|
int i, num_queues, size, ret; |
|
struct iwl_rfh_queue_config *cmd; |
|
struct iwl_host_cmd hcmd = { |
|
.id = WIDE_ID(DATA_PATH_GROUP, RFH_QUEUE_CONFIG_CMD), |
|
.dataflags[0] = IWL_HCMD_DFL_NOCOPY, |
|
}; |
|
|
|
/* |
|
* The default queue is configured via context info, so if we |
|
* have a single queue, there's nothing to do here. |
|
*/ |
|
if (fwrt->trans->num_rx_queues == 1) |
|
return 0; |
|
|
|
if (fwrt->trans->trans_cfg->device_family < IWL_DEVICE_FAMILY_22000) |
|
return 0; |
|
|
|
/* skip the default queue */ |
|
num_queues = fwrt->trans->num_rx_queues - 1; |
|
|
|
size = struct_size(cmd, data, num_queues); |
|
|
|
cmd = kzalloc(size, GFP_KERNEL); |
|
if (!cmd) |
|
return -ENOMEM; |
|
|
|
cmd->num_queues = num_queues; |
|
|
|
for (i = 0; i < num_queues; i++) { |
|
struct iwl_trans_rxq_dma_data data; |
|
|
|
cmd->data[i].q_num = i + 1; |
|
iwl_trans_get_rxq_dma_data(fwrt->trans, i + 1, &data); |
|
|
|
cmd->data[i].fr_bd_cb = cpu_to_le64(data.fr_bd_cb); |
|
cmd->data[i].urbd_stts_wrptr = |
|
cpu_to_le64(data.urbd_stts_wrptr); |
|
cmd->data[i].ur_bd_cb = cpu_to_le64(data.ur_bd_cb); |
|
cmd->data[i].fr_bd_wid = cpu_to_le32(data.fr_bd_wid); |
|
} |
|
|
|
hcmd.data[0] = cmd; |
|
hcmd.len[0] = size; |
|
|
|
ret = iwl_trans_send_cmd(fwrt->trans, &hcmd); |
|
|
|
kfree(cmd); |
|
|
|
if (ret) |
|
IWL_ERR(fwrt, "Failed to configure RX queues: %d\n", ret); |
|
|
|
return ret; |
|
} |
|
IWL_EXPORT_SYMBOL(iwl_configure_rxq);
|
|
|