axs103: Clean-up smp_kick_all_cpus()

[people/ms/u-boot.git] / board / synopsys / axs10x / axs10x.c

diff --git a/board/synopsys/axs10x/axs10x.c b/board/synopsys/axs10x/axs10x.c
index a5e774b2cf7b26e8d12b801e3e545b6e94666991..57c790220f7103817c28857fc7d4457a101d2424 100644 (file)
--- a/board/synopsys/axs10x/axs10x.c
+++ b/board/synopsys/axs10x/axs10x.c
@@ -61,16 +61,14 @@ void smp_kick_all_cpus(void)
 {
 /* CPU start CREG */
 #define AXC003_CREG_CPU_START  0xF0001400
-
 /* Bits positions in CPU start CREG */
 #define BITS_START     0
-#define BITS_POLARITY  8
+#define BITS_START_MODE        4
 #define BITS_CORE_SEL  9
-#define BITS_MULTICORE 12
-
-#define CMD    (1 << BITS_MULTICORE) | (1 << BITS_CORE_SEL) | \
-               (1 << BITS_POLARITY) | (1 << BITS_START)
 
-       writel(CMD, (void __iomem *)AXC003_CREG_CPU_START);
+       int cmd = readl((void __iomem *)AXC003_CREG_CPU_START);
+       cmd |= (1 << BITS_CORE_SEL) | (1 << BITS_START);
+       cmd &= ~(1 << BITS_START_MODE);
+       writel(cmd, (void __iomem *)AXC003_CREG_CPU_START);
 }
 #endif