soc: samsung: chipid: Add exynos_chipid_read_bits() function

Add register read helper function needed by the ASV driver.

Change-Id: I90ec78cff58ac7ff424a50309e83d37605e7cbc7
Signed-off-by: Sylwester Nawrocki <s.nawrocki@samsung.com>

diff --git a/drivers/soc/samsung/exynos-chipid.c b/drivers/soc/samsung/exynos-chipid.c
index 4920f0ef2c559c546a1b9531e094d54224ad34f9..17d06d21bc6fc4bb84cd529b3ee1aa86f1908f70 100644 (file)
--- a/drivers/soc/samsung/exynos-chipid.c
+++ b/drivers/soc/samsung/exynos-chipid.c
@@ -44,6 +44,12 @@ unsigned int exynos_chipid_read(unsigned int offset)
        return readl_relaxed(exynos_chipid_base + offset);
 }
 
+unsigned int exynos_chipid_read_bits(unsigned int offset, unsigned int shift,
+                                    unsigned int mask)
+{
+       return (readl_relaxed(exynos_chipid_base + offset) >> shift) & mask;
+}
+
 static const char * __init product_id_to_soc_id(unsigned int product_id)
 {
        int i;

diff --git a/drivers/soc/samsung/exynos-chipid.h b/drivers/soc/samsung/exynos-chipid.h
index 826a12c25fa2d0997b2f2ac7145edf9313430aef..7545281205227205679bf66d23bf6a9c6addd393 100644 (file)
--- a/drivers/soc/samsung/exynos-chipid.h
+++ b/drivers/soc/samsung/exynos-chipid.h
@@ -46,3 +46,5 @@
  #define EXYNOS5422_KFC_DN_MASK                0x03
 
 unsigned int exynos_chipid_read(unsigned int offset);
+unsigned int exynos_chipid_read_bits(unsigned int offset, unsigned int shift,
+                                       unsigned int mask);