From dda954f250cbc4e1adc123b854bea74c29536429 Mon Sep 17 00:00:00 2001 From: Troy Kisky <troy.kisky@boundarydevices.com> Date: Fri, 2 Dec 2016 13:20:35 -0700 Subject: [PATCH] ipu_disp: add set_bit_ so that mx51evk links Signed-off-by: Troy Kisky <troy.kisky@boundarydevices.com> --- drivers/video/ipu_disp.c | 12 +++++++++++- 1 file changed, 11 insertions(+), 1 deletion(-) diff --git a/drivers/video/ipu_disp.c b/drivers/video/ipu_disp.c index 0cb1bd86ea6..7fa5c37a912 100644 --- a/drivers/video/ipu_disp.c +++ b/drivers/video/ipu_disp.c @@ -834,6 +834,16 @@ static unsigned long offset_mask_bitmap; #define DC_MAPPING_PTR_MAX 29 static unsigned long mapping_bitmap; +static void set_bit_(int nr, volatile void *addr) +{ + int mask; + unsigned int *a = (unsigned int *)addr; + + a += nr >> 5; + mask = 1 << (nr & 0x1f); + *a |= mask; +} + static int find_field(u32 val, u32 *reg_base, unsigned long* bitmap, int max) { int i = 0; @@ -863,7 +873,7 @@ static int find_field(u32 val, u32 *reg_base, unsigned long* bitmap, int max) reg &= ~(0xFFFF << (16 * (i & 0x1))); reg |= val << (16 * (i & 0x1)); __raw_writel(reg, ®_base[i >> 1]); - set_bit(i, bitmap); + set_bit_(i, bitmap); debug("%s: [%d] = 0x%x max=%d\n", __func__, i, val, max); return i; } -- GitLab