164 lines
4.1 KiB
C
164 lines
4.1 KiB
C
/* SPDX-License-Identifier: GPL-2.0 */
|
|
/*
|
|
* Copyright (C) 2016 MediaTek Inc.
|
|
*/
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include "mmdvfs_plat.h"
|
|
#include "mtk_qos_sram.h"
|
|
#include "smi_pmqos.h"
|
|
#include <dt-bindings/memory/mt6885-larb-port.h>
|
|
|
|
#undef pr_fmt
|
|
#define pr_fmt(fmt) "[mmdvfs][plat]" fmt
|
|
|
|
|
|
#define LARB_MDP_ID 2
|
|
#define LARB_MDP2_ID 3
|
|
#define LARB_VENC_ID 7
|
|
#define LARB_VENC2_ID 8
|
|
#define LARB_IMG_ID 9
|
|
#define LARB_IMG2_ID 11
|
|
#define LARB_CAM_ID 13
|
|
#define LARB_CAM2_ID 14
|
|
#define LARB_CAM3_ID 16
|
|
#define LARB_CAM4_ID 17
|
|
#define LARB_CAM5_ID 18
|
|
|
|
|
|
static const u32 mdp_comm_port_shift = (1 * SMI_COMM_MASTER_NUM + 0);
|
|
static const u32 mdp_comm_port2_shift = (1 * SMI_COMM_MASTER_NUM + 1);
|
|
static const u32 venc_comm_port_shift = (0 * SMI_COMM_MASTER_NUM + 3);
|
|
static const u32 venc_comm_port2_shift = (1 * SMI_COMM_MASTER_NUM + 3);
|
|
static const u32 img_comm_port_shift = (1 * SMI_COMM_MASTER_NUM + 4);
|
|
static const u32 img_comm_port2_shift = (0 * SMI_COMM_MASTER_NUM + 4);
|
|
static const u32 cam_comm_port_shift = (1 * SMI_COMM_MASTER_NUM + 6);
|
|
static const u32 cam_comm_port2_shift = (0 * SMI_COMM_MASTER_NUM + 6);
|
|
static const u32 cam_comm_port3_shift = (1 * SMI_COMM_MASTER_NUM + 7);
|
|
static const u32 cam_comm_port4_shift = (0 * SMI_COMM_MASTER_NUM + 7);
|
|
static const u32 cam_comm_port5_shift = (1 * SMI_COMM_MASTER_NUM + 5);
|
|
|
|
#ifdef QOS_BOUND_DETECT
|
|
void mmdvfs_update_qos_sram(struct mm_larb_request larb_req[], u32 larb_update)
|
|
{
|
|
|
|
u32 bw;
|
|
|
|
if (larb_update & ((1 << mdp_comm_port_shift)
|
|
| (1 << mdp_comm_port2_shift))) {
|
|
bw = larb_req[LARB_MDP_ID].total_bw_data;
|
|
bw += larb_req[LARB_MDP2_ID].total_bw_data;
|
|
qos_sram_write(MM_SMI_MDP, bw);
|
|
}
|
|
|
|
if (larb_update & ((1 << venc_comm_port_shift)
|
|
| (1 << venc_comm_port2_shift))) {
|
|
bw = larb_req[LARB_VENC_ID].total_bw_data;
|
|
bw += larb_req[LARB_VENC2_ID].total_bw_data;
|
|
qos_sram_write(MM_SMI_VENC, bw);
|
|
}
|
|
|
|
if (larb_update & ((1 << img_comm_port_shift)
|
|
| (1 << img_comm_port2_shift))) {
|
|
bw = larb_req[LARB_IMG_ID].total_bw_data;
|
|
bw += larb_req[LARB_IMG2_ID].total_bw_data;
|
|
qos_sram_write(MM_SMI_IMG, bw);
|
|
}
|
|
|
|
if (larb_update & ((1 << cam_comm_port_shift)
|
|
| (1 << cam_comm_port2_shift)
|
|
| (1 << cam_comm_port3_shift)
|
|
| (1 << cam_comm_port4_shift)
|
|
| (1 << cam_comm_port5_shift))) {
|
|
bw = larb_req[LARB_CAM_ID].total_bw_data;
|
|
bw += larb_req[LARB_CAM2_ID].total_bw_data;
|
|
bw += larb_req[LARB_CAM3_ID].total_bw_data;
|
|
bw += larb_req[LARB_CAM4_ID].total_bw_data;
|
|
bw += larb_req[LARB_CAM5_ID].total_bw_data;
|
|
qos_sram_write(MM_SMI_CAM, bw);
|
|
}
|
|
}
|
|
#endif
|
|
static u32 log_common_port_ids;
|
|
static u32 log_larb_ids;
|
|
bool mmdvfs_log_larb_mmp(s32 common_port_id, s32 larb_id)
|
|
{
|
|
if (common_port_id >= 0)
|
|
return (1 << common_port_id) & log_common_port_ids;
|
|
if (larb_id >= 0)
|
|
return (1 << larb_id) & log_larb_ids;
|
|
return false;
|
|
}
|
|
|
|
/* Return port number of CCU on SMI common */
|
|
inline u32 mmdvfs_get_ccu_smi_common_port(u32 master_id)
|
|
{
|
|
if (master_id == get_virtual_port(VIRTUAL_CCU_COMMON))
|
|
return 6;
|
|
else
|
|
return ((1 << 16) | (6));
|
|
}
|
|
|
|
s32 get_ccu_hrt_bw(struct mm_larb_request larb_req[])
|
|
{
|
|
struct mm_qos_request *enum_req = NULL;
|
|
s32 bw = larb_req[MTK_IOMMU_TO_LARB(get_virtual_port(
|
|
VIRTUAL_CCU_COMMON))].total_hrt_data;
|
|
bw += larb_req[MTK_IOMMU_TO_LARB(get_virtual_port(
|
|
VIRTUAL_CCU_COMMON2))].total_hrt_data;
|
|
|
|
list_for_each_entry(enum_req,
|
|
&larb_req[LARB_CAM_ID].larb_list, larb_node) {
|
|
if (enum_req->master_id == M4U_PORT_L13_CAM_CCUI_MDP
|
|
|| enum_req->master_id == M4U_PORT_L13_CAM_CCUO_MDP)
|
|
bw += enum_req->hrt_value;
|
|
}
|
|
list_for_each_entry(enum_req,
|
|
&larb_req[LARB_CAM2_ID].larb_list, larb_node) {
|
|
if (enum_req->master_id == M4U_PORT_L14_CAM_CCUI_DISP
|
|
|| enum_req->master_id == M4U_PORT_L14_CAM_CCUO_DISP)
|
|
bw += enum_req->hrt_value;
|
|
}
|
|
return bw;
|
|
}
|
|
|
|
s32 get_md_hrt_bw(void)
|
|
{
|
|
#if IS_ENABLED(CONFIG_MACH_MT6893)
|
|
return 3344;
|
|
#else
|
|
return 4362;
|
|
#endif
|
|
}
|
|
|
|
s32 dram_write_weight(s32 val)
|
|
{
|
|
#if IS_ENABLED(CONFIG_MACH_MT6893)
|
|
return val;
|
|
#else
|
|
return (val * 6 / 5);
|
|
#endif
|
|
}
|
|
|
|
s32 emi_occ_ratio(void)
|
|
{
|
|
return 500;
|
|
}
|
|
|
|
s32 emi_occ_ui_only(void)
|
|
{
|
|
return 500;
|
|
}
|
|
|
|
s32 cam_occ_ratio(void)
|
|
{
|
|
return 1000;
|
|
}
|
|
|
|
s32 disp_occ_ratio(void)
|
|
{
|
|
return 1000;
|
|
}
|
|
|