wait: add check for waiti

waiti can only work with interrupt level 0, check if the level is 0 and
set SOF_IPC_PANIC_WFI panic.

Signed-off-by: Liam Girdwood <liam.r.girdwood@linux.intel.com>
Signed-off-by: Pan Xiuli <xiuli.pan@linux.intel.com>

Author: xiulipan

src/arch/xtensa/include/arch/wait.h

@@ -29,13 +29,20 @@
  */
 
 #include <xtensa/xtruntime.h>
+#include <arch/interrupt.h>
+#include <sof/panic.h>
+
 
 #if defined(PLATFORM_WAITI_DELAY)
 
 static inline void arch_wait_for_interrupt(int level)
 {
 	int i;
 
+	/* can only eneter WFI when at runlevel 0 i.e. not IRQ level */
+	if (arch_interrupt_get_level() > 0)
+		panic(SOF_IPC_PANIC_WFI);
+
 	/* this sequnce must be atomic on LX6 */
 	XTOS_SET_INTLEVEL(5);
 
@@ -55,7 +62,11 @@ static inline void arch_wait_for_interrupt(int level)
 
 static inline void arch_wait_for_interrupt(int level)
 {
-	 asm volatile("waiti 0");
+	/* can only eneter WFI when at runlevel 0 i.e. not IRQ level */
+	if (arch_interrupt_get_level() > 0)
+		panic(SOF_IPC_PANIC_WFI);
+
+	asm volatile("waiti 0");
 }
 
 #endif

src/include/uapi/ipc.h

@@ -144,16 +144,17 @@
 #define SOF_IPC_PANIC_MAGIC			0x0dead000
 #define SOF_IPC_PANIC_MAGIC_MASK		0x0ffff000
 #define SOF_IPC_PANIC_CODE_MASK			0x00000fff
-#define SOF_IPC_PANIC_MEM			(SOF_IPC_PANIC_MAGIC | 0)
-#define SOF_IPC_PANIC_WORK			(SOF_IPC_PANIC_MAGIC | 1)
-#define SOF_IPC_PANIC_IPC			(SOF_IPC_PANIC_MAGIC | 2)
-#define SOF_IPC_PANIC_ARCH			(SOF_IPC_PANIC_MAGIC | 3)
-#define SOF_IPC_PANIC_PLATFORM			(SOF_IPC_PANIC_MAGIC | 4)
-#define SOF_IPC_PANIC_TASK			(SOF_IPC_PANIC_MAGIC | 5)
-#define SOF_IPC_PANIC_EXCEPTION			(SOF_IPC_PANIC_MAGIC | 6)
-#define SOF_IPC_PANIC_DEADLOCK			(SOF_IPC_PANIC_MAGIC | 7)
-#define SOF_IPC_PANIC_STACK			(SOF_IPC_PANIC_MAGIC | 8)
-#define SOF_IPC_PANIC_IDLE			(SOF_IPC_PANIC_MAGIC | 9)
+#define SOF_IPC_PANIC_MEM			(SOF_IPC_PANIC_MAGIC | 0x0)
+#define SOF_IPC_PANIC_WORK			(SOF_IPC_PANIC_MAGIC | 0x1)
+#define SOF_IPC_PANIC_IPC			(SOF_IPC_PANIC_MAGIC | 0x2)
+#define SOF_IPC_PANIC_ARCH			(SOF_IPC_PANIC_MAGIC | 0x3)
+#define SOF_IPC_PANIC_PLATFORM			(SOF_IPC_PANIC_MAGIC | 0x4)
+#define SOF_IPC_PANIC_TASK			(SOF_IPC_PANIC_MAGIC | 0x5)
+#define SOF_IPC_PANIC_EXCEPTION			(SOF_IPC_PANIC_MAGIC | 0x6)
+#define SOF_IPC_PANIC_DEADLOCK			(SOF_IPC_PANIC_MAGIC | 0x7)
+#define SOF_IPC_PANIC_STACK			(SOF_IPC_PANIC_MAGIC | 0x8)
+#define SOF_IPC_PANIC_IDLE			(SOF_IPC_PANIC_MAGIC | 0x9)
+#define SOF_IPC_PANIC_WFI			(SOF_IPC_PANIC_MAGIC | 0xa)
 
 /*
  * SOF memory capabilities, add new ones at the end