Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 | /* * Copyright (c) 2016 Intel Corporation. * * SPDX-License-Identifier: Apache-2.0 */ #include <arch/x86/asm.h> #ifdef CONFIG_SYS_POWER_DEEP_SLEEP GDATA(_pm_save_gdtr) GDATA(_pm_save_idtr) GDATA(_pm_save_esp) GTEXT(_sys_soc_resume_from_deep_sleep) GTEXT(_power_restore_cpu_context) GTEXT(_power_soc_sleep) GTEXT(_power_soc_deep_sleep) SECTION_FUNC(TEXT, save_cpu_context) movl %esp, %eax /* save ptr to return address */ pushf /* save flags */ pusha /* save GPRs */ #if defined (CONFIG_DEBUG) || defined (CONFIG_SOC_WATCH) /* save the debug registers */ movl %dr0, %edx pushl %edx movl %dr1, %edx pushl %edx movl %dr2, %edx pushl %edx movl %dr3, %edx pushl %edx movl %dr6, %edx pushl %edx movl %dr7, %edx pushl %edx #endif movl %esp, _pm_save_esp /* save stack ptr */ sidtl _pm_save_idtr /* save idtr */ sgdtl _pm_save_gdtr /* save gdtr */ pushl (%eax) /* push return address */ ret SECTION_FUNC(TEXT, _power_restore_cpu_context) lgdtl _pm_save_gdtr /* restore gdtr */ lidtl _pm_save_idtr /* restore idtr */ movl _pm_save_esp, %esp /* restore saved stack ptr */ #if defined (CONFIG_DEBUG) || defined (CONFIG_SOC_WATCH) /* restore the debug registers */ popl %edx movl %edx, %dr7 popl %edx movl %edx, %dr6 popl %edx movl %edx, %dr3 popl %edx movl %edx, %dr2 popl %edx movl %edx, %dr1 popl %edx movl %edx, %dr0 #endif popa /* restore saved GPRs */ popf /* restore saved flags */ /* * At this point the stack contents will be as follows: * * Saved context * ESP ---> Return address of save_cpu_context * Return address of _power_soc_sleep/deep_sleep * * We just popped the saved context. Next we pop out the address * of the caller of save_cpu_context.Then the ret would return * to caller of _power_soc_sleep or _power_soc_deep_sleep. * */ addl $4, %esp ret SECTION_FUNC(TEXT, _power_soc_sleep) call save_cpu_context wbinvd call qm_power_soc_sleep /* Does not return */ SECTION_FUNC(TEXT, _power_soc_deep_sleep) call save_cpu_context wbinvd call qm_power_soc_deep_sleep /* Does not return */ /* * This is an example function to handle the deep sleep resume notification * in the absence of bootloader context restore support. * * Bootloader in Intel Quark SE Microcontroller C1000 boards have * context restore support and this would not be required. * * Disclaimer: This can be used for debug or development purposes. This is not * a supported feature in Quark SE boards and to be used at one's own risk. */ SECTION_FUNC(TEXT, _sys_soc_resume_from_deep_sleep) movl $CONFIG_BSP_SHARED_RESTORE_INFO_RAM_ADDR, %eax cmpl $_power_restore_cpu_context, (%eax) je _power_restore_cpu_context ret #endif |