A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-14 08:36:12 -04:00
Code Issues Projects Releases Packages Wiki Activity

hwkm: Empty RSP buffer before any command

Browse source 
Empty the RSP fifo before executing any command in case
there is some stale data from previous commands.

Change-Id: I6f15e8f5a8e901da224e89b741c503d408b9449f
Signed-off-by: Gaurav Kashyap <gaurkash@codeaurora.org>
This commit is contained in:
Gaurav Kashyap 2020-09-25 10:40:41 -07:00 • committed by Gerrit - the friendly Code Review server
commit 58d2ca31d7
1 changed files with 34 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

34
drivers/soc/qcom/hwkm.c
View file

@ -143,6 +143,7 @@ static int qti_hwkm_master_transaction(struct hwkm_device *dev,
int i = 0;
int err = 0;
u32 val = 0;
uint32_t rsp_discard;
// Clear CMD FIFO
qti_hwkm_setb(dev, QTI_HWKM_MASTER_RG_BANK2_BANKN_CTL,
@ -177,6 +178,22 @@ static int qti_hwkm_master_transaction(struct hwkm_device *dev,
return -err;
}
if (qti_hwkm_testb(dev, QTI_HWKM_MASTER_RG_BANK2_BANKN_IRQ_STATUS,
RSP_FIFO_NOT_EMPTY, KM_MASTER)) {
while (qti_hwkm_get_reg_data(dev,
QTI_HWKM_MASTER_RG_BANK2_BANKN_STATUS,
RSP_FIFO_AVAILABLE_DATA, RSP_FIFO_AVAILABLE_DATA_MASK,
KM_MASTER) > 0) {
rsp_discard = qti_hwkm_readl(dev,
QTI_HWKM_MASTER_RG_BANK2_RSP_0, KM_MASTER);
}
// Clear RSP_FIFO_NOT_EMPTY status bit
qti_hwkm_setb(dev, QTI_HWKM_MASTER_RG_BANK2_BANKN_IRQ_STATUS,
RSP_FIFO_NOT_EMPTY, KM_MASTER);
/* Write memory barrier */
wmb();
}
for (i = 0; i < cmd_words; i++) {
WAIT_UNTIL(qti_hwkm_get_reg_data(dev,
QTI_HWKM_MASTER_RG_BANK2_BANKN_STATUS,
@ -258,6 +275,7 @@ static int qti_hwkm_ice_transaction(struct hwkm_device *dev,
int i = 0;
int err = 0;
u32 val = 0;
uint32_t rsp_discard;
// Clear CMD FIFO
qti_hwkm_setb(dev, QTI_HWKM_ICE_RG_BANK0_BANKN_CTL,
@ -293,6 +311,22 @@ static int qti_hwkm_ice_transaction(struct hwkm_device *dev,
return err;
}
if (qti_hwkm_testb(dev, QTI_HWKM_ICE_RG_BANK0_BANKN_IRQ_STATUS,
RSP_FIFO_NOT_EMPTY, ICEMEM_SLAVE)) {
while (qti_hwkm_get_reg_data(dev,
QTI_HWKM_ICE_RG_BANK0_BANKN_STATUS,
RSP_FIFO_AVAILABLE_DATA, RSP_FIFO_AVAILABLE_DATA_MASK,
ICEMEM_SLAVE) > 0) {
rsp_discard = qti_hwkm_readl(dev,
QTI_HWKM_ICE_RG_BANK0_RSP_0, ICEMEM_SLAVE);
}
// Clear RSP_FIFO_NOT_EMPTY status bit
qti_hwkm_setb(dev, QTI_HWKM_ICE_RG_BANK0_BANKN_IRQ_STATUS,
RSP_FIFO_NOT_EMPTY, ICEMEM_SLAVE);
/* Write memory barrier */
wmb();
}
for (i = 0; i < cmd_words; i++) {
WAIT_UNTIL(qti_hwkm_get_reg_data(dev,
QTI_HWKM_ICE_RG_BANK0_BANKN_STATUS,