msm: fd: Add FD HW reset sequence after halt

The FD hardware needs to be reset everytime after halt
is called. Adding the reset sequence.

CRs-fixed: 961394

Change-Id: I129de341e619d8c8f6faa69d43c9d13ba21dd88f
Signed-off-by: Ashwini Rao <ashwinik@codeaurora.org>
This commit is contained in:
Ashwini Rao 2016-01-21 15:17:21 -08:00 committed by David Keitel
parent 850b0ec74f
commit 0f31b83fcf

View file

@ -493,6 +493,14 @@ static void msm_fd_hw_halt(struct msm_fd_device *fd)
if (!time)
dev_err(fd->dev, "Face detection halt timeout\n");
/* Reset sequence after halt */
msm_fd_hw_write_reg(fd, MSM_FD_IOMEM_MISC, MSM_FD_MISC_SW_RESET,
MSM_FD_MISC_SW_RESET_SET);
msm_fd_hw_write_reg(fd, MSM_FD_IOMEM_CORE, MSM_FD_CONTROL,
MSM_FD_CONTROL_SRST);
msm_fd_hw_write_reg(fd, MSM_FD_IOMEM_MISC,
MSM_FD_MISC_SW_RESET, 0);
msm_fd_hw_write_reg(fd, MSM_FD_IOMEM_CORE, MSM_FD_CONTROL, 0);
}
}