Files
linux-nv-oot/drivers/platform/tegra/dce/dce-hsp-ss.c
Mahesh Kumar b2d304096e platform: dce: fix ss clear reg address
This patch fixes a typo in ss_clear_regs.

Bug 3500242

Change-Id: If6d08219abc8a0c233c91e769077d793db5bbe3d
Signed-off-by: Mahesh Kumar <mahkumar@nvidia.com>
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nvidia/+/2654239
Reviewed-by: svcacv <svcacv@nvidia.com>
Reviewed-by: svc_kernel_abi <svc_kernel_abi@nvidia.com>
Reviewed-by: Arun Swain <arswain@nvidia.com>
GVS: Gerrit_Virtual_Submit
2023-04-14 19:23:43 +00:00

145 lines
3.2 KiB
C

/*
* Copyright (c) 2019-2022, NVIDIA CORPORATION. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
* version 2, as published by the Free Software Foundation.
*
* This program is distributed in the hope 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.
*/
#include <dce.h>
#include <dce-log.h>
#include <dce-util-common.h>
#define DCE_MAX_NO_SS 4
/**
* ss_set_regs is a 1D array of read-only pointers to a function returning u32.
*
* Array of functions that retrun base addresses of shared semaphores set
* registers in DCE cluster based on the semaphore id.
*/
static u32 (*const ss_set_regs[DCE_MAX_NO_SS])(void) = {
hsp_ss0_set_r,
hsp_ss1_set_r,
hsp_ss2_set_r,
hsp_ss3_set_r,
};
/**
* ss_clear_regs is a 1D array of read-only pointers to a function
* returning u32.
*
* Array of functions that retrun base addresses of shared semaphores clear
* registers in DCE cluster based on the semaphore id.
*/
static u32 (*const ss_clear_regs[DCE_MAX_NO_SS])(void) = {
hsp_ss0_clr_r,
hsp_ss1_clr_r,
hsp_ss2_clr_r,
hsp_ss3_clr_r,
};
/**
* ss_state_regs is a 1D array of read-only pointers to a function
* returning u32.
*
* Array of functions that retrun base addresses of shared semaphores state
* registers in DCE cluster based on the semaphore id.
*/
static u32 (*const ss_state_regs[DCE_MAX_NO_SS])(void) = {
hsp_ss0_state_r,
hsp_ss1_state_r,
hsp_ss2_state_r,
hsp_ss3_state_r,
};
/**
* dce_ss_get_state - Get the state of ss_#n in the DCE Cluster
*
* @d : Pointer to tegra_dce struct.
* @id : Shared Semaphore Id.
*
* Return : u32
*/
u32 dce_ss_get_state(struct tegra_dce *d, u8 id)
{
return dce_readl(d, ss_state_regs[id]());
}
/**
* dce_ss_set - Set an u32 value to ss_#n in the DCE Cluster
*
* @d : Pointer to tegra_dce struct.
* @bpos : bit to be set.
* @id : Shared Semaphore Id.
*
* Return : Void
*/
void dce_ss_set(struct tegra_dce *d, u8 bpos, u8 id)
{
unsigned long val = 0U;
if (id >= DCE_MAX_NO_SS) {
dce_err(d, "Invalid Shared Semaphore ID");
return;
}
val = dce_ss_get_state(d, id);
/**
* Debug info. please remove
*/
dce_info(d, "Current Value in SS#%d : %lx", id, val);
/**
* TODO :Use DCE_INSERT here.
*/
dce_bitmap_set(&val, bpos, 1);
/**
* Debug info. please remove
*/
dce_info(d, "Value after bitmap operation : %lx", val);
dce_writel(d, ss_set_regs[id](), (u32)val);
/**
* Debug info. please remove
*/
val = dce_ss_get_state(d, id);
dce_info(d, "Current Value in SS#%d : %lx", id, val);
}
/**
* dce_ss_clear - Clear a bit in ss_#n in the DCE Cluster
*
* @d : Pointer to tegra_dce struct.
* @bpos : bit to be cleared.
* @id : Shared Semaphore Id.
*
* Return : Void
*/
void dce_ss_clear(struct tegra_dce *d, u8 bpos, u8 id)
{
unsigned long val;
if (id >= DCE_MAX_NO_SS) {
dce_err(d, "Invalid Shared Semaphore ID");
return;
}
val = dce_ss_get_state(d, id);
dce_bitmap_set(&val, bpos, 1);
dce_writel(d, ss_clear_regs[id](), val);
}