1 files changed, 24 insertions, 0 deletions

diff --git a/firmware/target/mips/ingenic_jz47xx/system-target.h b/firmware/target/mips/ingenic_jz47xx/system-target.h
index caf1733158..1c2e7d7173 100644
--- a/firmware/target/mips/ingenic_jz47xx/system-target.h
+++ b/firmware/target/mips/ingenic_jz47xx/system-target.h
@@ -97,4 +97,28 @@ void dma_disable(void);
 #define DMA_IRQ(n)      (IRQ_DMA_0 + (n))
 #define GPIO_IRQ(n)     (IRQ_GPIO_0 + (n))
 
+/*---------------------------------------------------------------------------
+ * Put core in a power-saving state.
+ *---------------------------------------------------------------------------
+ */
+static inline void core_sleep(void)
+{
+#if CONFIG_CPU == JZ4732
+    __cpm_idle_mode();
+#endif
+    asm volatile(".set   mips32r2           \n"
+                 "mfc0   $8, $12            \n" /* mfc t0, $12 */
+                 "move   $9, $8             \n" /* move t1, t0 */
+                 "la     $10, 0x8000000     \n" /* la t2, 0x8000000 */
+                 "or     $8, $8, $10        \n" /* Enable reduced power mode */
+                 "mtc0   $8, $12            \n" /* mtc t0, $12 */
+                 "wait                      \n"
+                 "mtc0   $9, $12            \n" /* mtc t1, $12 */
+                 ".set   mips0              \n"
+                 ::: "t0", "t1", "t2"
+                 );
+    enable_irq();
+}
+
+
 #endif /* __SYSTEM_TARGET_H_ */